source: rtems/cpukit/libcsupport/src/printk.c @ 108bab3

4.104.114.84.95
Last change on this file since 108bab3 was 108bab3, checked in by Eric Norum <WENorum@…>, on Oct 30, 2002 at 7:47:03 PM

Add vprintk function for kernel printing from routines
which have already obtained the va_list pointer.

  • Property mode set to 100644
File size: 4.0 KB
Line 
1/*-------------------------------------------------------------------------+
2| printk.c v1.1 - PC386 BSP - 1997/08/07
3+--------------------------------------------------------------------------+
4| (C) Copyright 1997 -
5| - NavIST Group - Real-Time Distributed Systems and Industrial Automation
6|
7| http://pandora.ist.utl.pt
8|
9| Instituto Superior Tecnico * Lisboa * PORTUGAL
10+--------------------------------------------------------------------------+
11| Disclaimer:
12|
13| This file is provided "AS IS" without warranty of any kind, either
14| expressed or implied.
15+--------------------------------------------------------------------------+
16| This code is based on code by: Jose Rufino - IST
17|
18|  $Id$
19+--------------------------------------------------------------------------*/
20
21#if HAVE_CONFIG_H
22#include "config.h"
23#endif
24
25#include <stdarg.h>
26#include <stdio.h>
27#include <rtems/bspIo.h>
28
29/*-------------------------------------------------------------------------+
30|         Function: printNum
31|      Description: print number in a given base.
32| Global Variables: None.
33|        Arguments: num - number to print, base - base used to print the number.
34|          Returns: Nothing.
35+--------------------------------------------------------------------------*/
36static void
37printNum(long unsigned int num, int base, int sign, int maxwidth, int lead)
38{
39  long unsigned int n;
40  int count;
41  char toPrint[20];
42
43  if ( (sign == 1) && ((long)num <  0) ) {
44    BSP_output_char('-');
45    num = -num;
46    if (maxwidth) maxwidth--;
47  }
48 
49  count = 0;
50  while ((n = num / base) > 0) {
51    toPrint[count++] = (num - (n*base));
52    num = n ;
53  }
54  toPrint[count++] = num;
55
56  if (maxwidth) {
57    for (n=maxwidth-count ; n ; n-- )
58      BSP_output_char(lead);
59  }
60
61  for (n = 0; n < count; n++){
62    BSP_output_char("0123456789ABCDEF"[(int)(toPrint[count-(n+1)])]);
63  }
64} /* printNum */
65
66
67/*-------------------------------------------------------------------------+
68|         Function: printk
69|      Description: a simplified version of printf intended for use when the
70                    console is not yet initialized or in ISR's.
71| Global Variables: None.
72|        Arguments: as in printf: fmt - format string, ... - unnamed arguments.
73|          Returns: Nothing.
74+--------------------------------------------------------------------------*/
75void
76vprintk(char *fmt, va_list ap)
77{
78  char     c, *str;
79  int      lflag, base, sign, width, lead;
80  /* unsigned int level; */
81
82  /* _CPU_ISR_Disable(level); */
83 
84  for (; *fmt != '\0'; fmt++)
85  {
86    lflag = 0;
87    base  = 0;
88    sign = 0;
89    width = 0;
90    lead = ' ';
91    if (*fmt == '%')
92    {
93      fmt++;
94      if (*fmt == '0' ) {
95        lead = '0';
96        fmt++;
97      }
98      while (*fmt >= '0' && *fmt <= '9' ) {
99        width *= 10;
100        width += (*fmt - '0');
101        fmt++;
102      }
103
104      if ((c = *fmt) == 'l')
105      {
106        lflag = 1;
107        c = *++fmt;
108      }
109      switch (c)
110      {
111        case 'o': case 'O': base = 8; sign = 0; break;
112        case 'd': case 'D': base = 10; sign = 1; break;
113        case 'u': case 'U': base = 10; sign = 0; break;
114        case 'x': case 'X': base = 16; sign = 0; break;
115        case 's':
116          for (str = va_arg(ap, char *); *str; str++) 
117            BSP_output_char(*str);
118          break;
119        case 'c':
120#if 0
121#if defined(_TMS320C3x) || defined(_TMS320C4x)
122          BSP_output_char(va_arg(ap, int));
123#else
124          BSP_output_char(va_arg(ap, char));
125#endif
126#else
127          BSP_output_char(va_arg(ap, int));
128#endif
129          break;
130        default:
131          BSP_output_char(c);
132          break;
133      } /* switch*/
134
135      if (base)
136        printNum(lflag ? va_arg(ap, long int) : (long int)va_arg(ap, int),
137                 base, sign, width, lead);
138    }
139    else
140    {
141      BSP_output_char(*fmt);
142    }
143  }
144  /* _CPU_ISR_Enable(level); */
145
146} /* vprintk */
147
148void
149printk(char *fmt, ...)
150{
151  va_list  ap;      /* points to each unnamed argument in turn */
152 
153  va_start(ap, fmt); /* make ap point to 1st unnamed arg */
154  vprintk(fmt, ap);
155  va_end(ap); /* clean up when done */
156} /* printk */
157
Note: See TracBrowser for help on using the repository browser.