diff options
author | Joel Sherrill <joel.sherrill@OARcorp.com> | 2009-05-15 15:02:43 +0000 |
---|---|---|
committer | Joel Sherrill <joel.sherrill@OARcorp.com> | 2009-05-15 15:02:43 +0000 |
commit | 7bd0dbc385ae19569fe3a5a1eebde201400138cd (patch) | |
tree | 714ec10d8a301628d0575af393a5426cdcb23aeb /cpukit/libcsupport/src/vprintk.c | |
parent | 2009-05-15 Sebastian Huber <sebastian.huber@embedded-brains.de> (diff) | |
download | rtems-7bd0dbc385ae19569fe3a5a1eebde201400138cd.tar.bz2 |
2009-05-15 Joel Sherrill <joel.sherrill@OARcorp.com>
* libcsupport/Makefile.am, libcsupport/src/printk.c: Restructure to
make analysis and coverage easier. Now 100% covered.
* libcsupport/src/vprintk.c: New file.
Diffstat (limited to '')
-rw-r--r-- | cpukit/libcsupport/src/vprintk.c | 182 |
1 files changed, 182 insertions, 0 deletions
diff --git a/cpukit/libcsupport/src/vprintk.c b/cpukit/libcsupport/src/vprintk.c new file mode 100644 index 0000000000..e7d5d1a59e --- /dev/null +++ b/cpukit/libcsupport/src/vprintk.c @@ -0,0 +1,182 @@ +/* + * (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$ + */ + +#if HAVE_CONFIG_H +#include "config.h" +#endif + +#include <stdarg.h> +#include <stdio.h> +#include <rtems/bspIo.h> + +static void printNum( + long unsigned int num, + int base, + int sign, + int maxwidth, + int lead +); + +/* + * vprintk + * + * A simplified version of printf intended for use when the + * console is not yet initialized or in ISR's. + * + * Arguments: + * as in printf: fmt - format string, ... - unnamed arguments. + */ +void vprintk( + const char *fmt, + va_list ap +) +{ + char c, *str; + int lflag, base, sign, width, lead, minus; + + for (; *fmt != '\0'; fmt++) { + lflag = 0; + base = 0; + sign = 0; + width = 0; + minus = 0; + lead = ' '; + if (*fmt != '%') { + BSP_output_char(*fmt); + continue; + } + fmt++; + if (*fmt == '0' ) { + lead = '0'; + fmt++; + } + if (*fmt == '-' ) { + minus = 1; + fmt++; + } + while (*fmt >= '0' && *fmt <= '9' ) { + width *= 10; + width += (*fmt - '0'); + fmt++; + } + + if ((c = *fmt) == 'l') { + lflag = 1; + c = *++fmt; + } + if ( c == 'c' ) { + BSP_output_char(va_arg(ap, int)); + continue; + } + if ( c == 's' ) { + int i, len; + char *s; + + str = va_arg(ap, char *); + + /* calculate length of string */ + for ( len=0, s=str ; *s ; len++, s++ ) + ; + + /* leading spaces */ + if ( !minus ) + for ( i=len ; i<width ; i++ ) + BSP_output_char(' '); + + /* no width option */ + if (width == 0) { + width = len; + } + + /* output the string */ + for ( i=0 ; i<width && *str ; str++ ) + BSP_output_char(*str); + + /* trailing spaces */ + if ( minus ) + for ( i=len ; i<width ; i++ ) + BSP_output_char(' '); + + continue; + } + + /* must be a numeric format or something unsupported */ + if ( c == 'o' || c == 'O' ) { + base = 8; sign = 0; + } else if ( c == 'i' || c == 'I' || + c == 'd' || c == 'D' ) { + base = 10; sign = 1; + } else if ( c == 'u' || c == 'U' ) { + base = 10; sign = 0; + } else if ( c == 'x' || c == 'X' ) { + base = 16; sign = 0; + } else if ( c == 'p' ) { + base = 16; sign = 0; lflag = 1; + } else { + BSP_output_char(c); + continue; + } + + printNum( + lflag ? va_arg(ap, long int) : (long int)va_arg(ap, int), + base, + sign, + width, + lead + ); + } +} + +/* + * printNum - print number in a given base. + * Arguments + * num - number to print + * base - base used to print the number. + */ +static void printNum( + long unsigned int num, + int base, + int sign, + int maxwidth, + int lead +) +{ + long unsigned int n; + int count; + char toPrint[20]; + + if ( (sign == 1) && ((long)num < 0) ) { + BSP_output_char('-'); + num = -num; + if (maxwidth) maxwidth--; + } + + count = 0; + while ((n = num / base) > 0) { + toPrint[count++] = (num - (n*base)); + num = n; + } + toPrint[count++] = num; + + for (n=maxwidth ; n > count; n-- ) + BSP_output_char(lead); + + for (n = 0; n < count; n++) { + BSP_output_char("0123456789ABCDEF"[(int)(toPrint[count-(n+1)])]); + } +} |