URL https://opencores.org/ocsvn/openrisc/openrisc/trunk

Subversion Repositories openrisc

[/] [openrisc/] [trunk/] [rtos/] [rtems/] [c/] [src/] [lib/] [libbsp/] [i386/] [shared/] [io/] [printk.c] - Blame information for rev 602

Go to most recent revision | Details | Compare with Previous | View Log


/*-------------------------------------------------------------------------+
| printk.c v1.1 - PC386 BSP - 1997/08/07
+--------------------------------------------------------------------------+
| (C) Copyright 1997 -
| - NavIST Group - Real-Time Distributed Systems and Industrial Automation
|
| http://pandora.ist.utl.pt
|
| Instituto Superior Tecnico * Lisboa * PORTUGAL
+--------------------------------------------------------------------------+
| Disclaimer:
|
| This file is provided "AS IS" without warranty of any kind, either
| expressed or implied.
+--------------------------------------------------------------------------+
| This code is based on code by: Jose Rufino - IST
|
|  $Id: printk.c,v 1.2 2001-09-27 11:59:49 chris Exp $
+--------------------------------------------------------------------------*/
 
 
#include <stdarg.h>
#include <stdio.h>
#include <bspIo.h>
#include <libcpu/cpu.h>
 
/*-------------------------------------------------------------------------+
|         Function: printNum
|      Description: print number in a given base.
| Global Variables: None.
|        Arguments: num - number to print, base - base used to print the number.
|          Returns: Nothing.
+--------------------------------------------------------------------------*/
static void
printNum(long unsigned int num, int base, int sign)
{
  long unsigned int n;
  int count;
  char toPrint[20];
 
  if ( (sign == 1) && ((long)num <  0) ) {
    BSP_output_char('-');
    num = -num;
  }
 
  count = 0;
  while ((n = num / base) > 0) {
    toPrint[count++] = (num - (n*base));
    num = n ;
  }
  toPrint[count++] = num;
 
  for (n = 0; n < count; n++){
    BSP_output_char("0123456789ABCDEF"[(int)(toPrint[count-(n+1)])]);
  }
} /* printNum */
 
 
/*-------------------------------------------------------------------------+
|         Function: printk
|      Description: a simplified version of printf intended for use when the
                    console is not yet initialized or in ISR's.
| Global Variables: None.
|        Arguments: as in printf: fmt - format string, ... - unnamed arguments.
|          Returns: Nothing.
+--------------------------------------------------------------------------*/
void
printk(char *fmt, ...)
{
  va_list  ap;      /* points to each unnamed argument in turn */
  char     c, *str;
  int      lflag, base, sign;
  unsigned int level;
 
  _CPU_ISR_Disable(level);
 
  va_start(ap, fmt); /* make ap point to 1st unnamed arg */
  for (; *fmt != '\0'; fmt++)
  {
    lflag = 0;
    base  = 0;
    sign = 0;
    if (*fmt == '%')
    {
      if ((c = *++fmt) == 'l')
      {
        lflag = 1;
        c = *++fmt;
      }
      switch (c)
      {
        case 'o': case 'O': base = 8; sign = 0; break;
        case 'd': case 'D': base = 10; sign = 1; break;
        case 'u': case 'U': base = 10; sign = 0; break;
        case 'x': case 'X': base = 16; sign = 0; break;
        case 's':
          for (str = va_arg(ap, char *); *str; str++)
            BSP_output_char(*str);
          break;
        case 'c':
          BSP_output_char(va_arg(ap, char));
          break;
        default:
          BSP_output_char(c);
          break;
      } /* switch*/
 
      if (base)
        printNum(lflag ? va_arg(ap, long int) : (long int)va_arg(ap, int),
                 base, sign);
    }
    else
    {
      BSP_output_char(*fmt);
    }
  }
  va_end(ap); /* clean up when done */
  _CPU_ISR_Enable(level);
 
} /* printk */
 

Line No.	Rev	Author	Line
1	30	unneback	`/*-------------------------------------------------------------------------+`
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: printk.c,v 1.2 2001-09-27 11:59:49 chris Exp $`
19			`+--------------------------------------------------------------------------*/`
20
21
22			`#include <stdarg.h>`
23			`#include <stdio.h>`
24			`#include <bspIo.h>`
25			`#include <libcpu/cpu.h>`
26
27			`/*-------------------------------------------------------------------------+`
28			`\| Function: printNum`
29			`\| Description: print number in a given base.`
30			`\| Global Variables: None.`
31			`\| Arguments: num - number to print, base - base used to print the number.`
32			`\| Returns: Nothing.`
33			`+--------------------------------------------------------------------------*/`
34			`static void`
35			`printNum(long unsigned int num, int base, int sign)`
36			`{`
37			`long unsigned int n;`
38			`int count;`
39			`char toPrint[20];`
40
41			`if ( (sign == 1) && ((long)num < 0) ) {`
42			`BSP_output_char('-');`
43			`num = -num;`
44			`}`
45
46			`count = 0;`
47			`while ((n = num / base) > 0) {`
48			`toPrint[count++] = (num - (n*base));`
49			`num = n ;`
50			`}`
51			`toPrint[count++] = num;`
52
53			`for (n = 0; n < count; n++){`
54			`BSP_output_char("0123456789ABCDEF"[(int)(toPrint[count-(n+1)])]);`
55			`}`
56			`} /* printNum */`
57
58
59			`/*-------------------------------------------------------------------------+`
60			`\| Function: printk`
61			`\| Description: a simplified version of printf intended for use when the`
62			`console is not yet initialized or in ISR's.`
63			`\| Global Variables: None.`
64			`\| Arguments: as in printf: fmt - format string, ... - unnamed arguments.`
65			`\| Returns: Nothing.`
66			`+--------------------------------------------------------------------------*/`
67			`void`
68			`printk(char *fmt, ...)`
69			`{`
70			`va_list ap; /* points to each unnamed argument in turn */`
71			`char c, *str;`
72			`int lflag, base, sign;`
73			`unsigned int level;`
74
75			`_CPU_ISR_Disable(level);`
76
77			`va_start(ap, fmt); /* make ap point to 1st unnamed arg */`
78			`for (; *fmt != '\0'; fmt++)`
79			`{`
80			`lflag = 0;`
81			`base = 0;`
82			`sign = 0;`
83			`if (*fmt == '%')`
84			`{`
85			`if ((c = *++fmt) == 'l')`
86			`{`
87			`lflag = 1;`
88			`c = *++fmt;`
89			`}`
90			`switch (c)`
91			`{`
92			`case 'o': case 'O': base = 8; sign = 0; break;`
93			`case 'd': case 'D': base = 10; sign = 1; break;`
94			`case 'u': case 'U': base = 10; sign = 0; break;`
95			`case 'x': case 'X': base = 16; sign = 0; break;`
96			`case 's':`
97			`for (str = va_arg(ap, char ); str; str++)`
98			`BSP_output_char(*str);`
99			`break;`
100			`case 'c':`
101			`BSP_output_char(va_arg(ap, char));`
102			`break;`
103			`default:`
104			`BSP_output_char(c);`
105			`break;`
106			`} /* switch*/`
107
108			`if (base)`
109			`printNum(lflag ? va_arg(ap, long int) : (long int)va_arg(ap, int),`
110			`base, sign);`
111			`}`
112			`else`
113			`{`
114			`BSP_output_char(*fmt);`
115			`}`
116			`}`
117			`va_end(ap); /* clean up when done */`
118			`_CPU_ISR_Enable(level);`
119
120			`} /* printk */`
121

Browse

Tools

Subversion Repositories openrisc

[/] [openrisc/] [trunk/] [rtos/] [rtems/] [c/] [src/] [lib/] [libbsp/] [i386/] [shared/] [io/] [printk.c] - Blame information for rev 602