/sw/lib/printf.c
C | 746 lines | 423 code | 84 blank | 239 comment | 81 complexity | 8fd6342c1caa8dc5934cb916f6a5cfc3 MD5 | raw file
- // Ripped out of latest ecos build from
- //http://sources-redhat.mirrors.airband.net/ecos/releases/ecos-3.0b1/ecos-3.0beta1.i386linux.tar.bz2
- // File: ecos-3.0b1/packages/language/c/libc/stdio/v3_0b1/src/output/vfnprintf.cxx
- // Hacked to pieces so it would work with OpenRISC compiler, not using libc
- //===========================================================================
- //
- // vfnprintf.c
- //
- // I/O routines for vfnprintf() for use with ANSI C library
- //
- //===========================================================================
- // ####ECOSGPLCOPYRIGHTBEGIN####
- // -------------------------------------------
- // This file is part of eCos, the Embedded Configurable Operating System.
- // Copyright (C) 1998, 1999, 2000, 2001, 2002 Free Software Foundation, Inc.
- //
- // eCos is free software; you can redistribute it and/or modify it under
- // the terms of the GNU General Public License as published by the Free
- // Software Foundation; either version 2 or (at your option) any later
- // version.
- //
- // eCos is distributed in the hope that it will be useful, but WITHOUT
- // ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
- // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
- // for more details.
- //
- // You should have received a copy of the GNU General Public License
- // along with eCos; if not, write to the Free Software Foundation, Inc.,
- // 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
- //
- // As a special exception, if other files instantiate templates or use
- // macros or inline functions from this file, or you compile this file
- // and link it with other works to produce a work based on this file,
- // this file does not by itself cause the resulting work to be covered by
- // the GNU General Public License. However the source code for this file
- // must still be made available in accordance with section (3) of the GNU
- // General Public License v2.
- //
- // This exception does not invalidate any other reasons why a work based
- // on this file might be covered by the GNU General Public License.
- // -------------------------------------------
- // ####ECOSGPLCOPYRIGHTEND####
- //===========================================================================
- //#####DESCRIPTIONBEGIN####
- //
- // Author(s): jlarmour
- // Contributors:
- // Date: 2000-04-20
- // Purpose:
- // Description:
- // Usage:
- //
- //####DESCRIPTIONEND####
- //
- //===========================================================================
- //
- // This code is based on original code with the following copyright:
- //
- /*-
- * Copyright (c) 1990 The Regents of the University of California.
- * All rights reserved.
- *
- * This code is derived from software contributed to Berkeley by
- * Chris Torek.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. Neither the name of the University nor the names of its contributors
- * may be used to endorse or promote products derived from this software
- * without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
- * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
- * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
- * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
- * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
- * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
- * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
- * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
- * SUCH DAMAGE.
- */
- // CONFIGURATION
- //#include <pkgconf/libc_stdio.h> // Configuration header
- //#include <pkgconf/libc_i18n.h> // Configuration header for mb support
- // INCLUDES
- //jb#include <stdarg.h> // Variable argument definitions
- //jb#include <string.h> // memchr() and strlen() functions
- //#include <stdio.h> // Standard header for all stdio files
- //#include <cyg/libc/stdio/stream.hxx> // C library streams
- //#include "vfnprintf.h"
- //jb#include <stddef.h> // for null, va_lsit
- #include "lib-utils.h" // has all these required basic c functions now
- //#include <cyg/infra/cyg_type.h> // Common type definitions and support
- #define CYG_MACRO_START do {
- #define CYG_MACRO_END } while (0)
- #define CYG_EMPTY_STATEMENT CYG_MACRO_START CYG_MACRO_END
- #define CYG_UNUSED_PARAM( _type_, _name_ ) CYG_MACRO_START \
- _type_ __tmp1 = (_name_); \
- _type_ __tmp2 = __tmp1; \
- __tmp1 = __tmp2; \
- CYG_MACRO_END
- # define BUF 40
- /*
- * Actual printf innards.
- *
- * This code is large and complicated...
- */
- /*
- * Macros for converting digits to letters and vice versa
- */
- #define to_digit(c) ((c) - '0')
- #define is_digit(c) ((unsigned)to_digit(c) <= 9)
- #define to_char(n) ((n) + '0')
- /*
- * Flags used during conversion.
- */
- #define ALT 0x001 /* alternate form */
- #define HEXPREFIX 0x002 /* add 0x or 0X prefix */
- #define LADJUST 0x004 /* left adjustment */
- #define LONGDBL 0x008 /* long double; unimplemented */
- #define LONGINT 0x010 /* long integer */
- #define QUADINT 0x020 /* quad integer */
- #define SHORTINT 0x040 /* short integer */
- #define ZEROPAD 0x080 /* zero (as opposed to blank) pad */
- #define FPT 0x100 /* Floating point number */
- #define SIZET 0x200 /* size_t */
- // Function which prints back to the buffer, ptr, len bytes
- // returns 1 if it should finish up, otherwise 0 to continue
- int
- print_back_to_string(char * ptr, int len, size_t * n, int * ret, char ** stream)
- {
- #define MIN(a, b) ((a) < (b) ? (a) : (b))
- do {
- int length = MIN( (int) len, *n - *ret - 1);
- memcpy(*stream + *ret, ptr, length);
- if (length < (int)len) {
- *ret += length;
- return 1; // finish up
- }
- } while(0);
-
- return 0;
- }
- //externC int
- int
- //vfnprintf ( FILE *stream, size_t n, const char *format, va_list arg) __THROW
- vfnprintf ( char *stream, size_t n, const char *format, va_list arg)
- {
- char *fmt; /* format string */
- int ch; /* character from fmt */
- int x, y; /* handy integers (short term usage) */
- char *cp; /* handy char pointer (short term usage) */
- int flags; /* flags as above */
-
- int ret; /* return value accumulator */
- int width; /* width from format (%8d), or 0 */
- int prec; /* precision from format (%.3d), or -1 */
- char sign; /* sign prefix (' ', '+', '-', or \0) */
- wchar_t wc;
-
- #define quad_t long long
- #define u_quad_t unsigned long long
-
- u_quad_t _uquad; /* integer arguments %[diouxX] */
- enum { OCT, DEC, HEX } base;/* base for [diouxX] conversion */
- int dprec; /* a copy of prec if [diouxX], 0 otherwise */
- int fieldsz; /* field size expanded by sign, etc */
- int realsz; /* field size expanded by dprec */
- int size; /* size of converted field or string */
- char *xdigs; /* digits for [xX] conversion */
- #define NIOV 8
- char buf[BUF]; /* space for %c, %[diouxX], %[eEfgG] */
- char ox[2]; /* space for 0x hex-prefix */
-
- /*
- * Choose PADSIZE to trade efficiency vs. size. If larger printf
- * fields occur frequently, increase PADSIZE and make the initialisers
- * below longer.
- */
- #define PADSIZE 16 /* pad chunk size */
- static char blanks[PADSIZE] =
- {' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' ',' '};
- static char zeroes[PADSIZE] =
- {'0','0','0','0','0','0','0','0','0','0','0','0','0','0','0','0'};
-
- /*
- * BEWARE, these `goto error' on error, and PAD uses `n'.
- */
-
- // We'll copy len bytes from (char*) ptr, into the output stream
- // making sure we don't go over the end, so calculate length to be
- // either the whole length we've been passed, or the whole length
- // that is possible to write
- // We finish if it was not possible to write the entire variable
- // into the buffer, ie we had to write all we could, not all we
- // wanted to.
- /*
- #define PRINT(ptr, len) \
- CYG_MACRO_START \
- int length = MIN( (int) len, n - ret - 1); \
- char* begin_stream_write = stream; \
- stream = memcpy(stream, ptr, length); \
- length = (unsigned long) stream - (unsigned long) begin_stream_write; \
- if (length < (int)len) { \
- ret += length; \
- goto done; \
- } \
- CYG_MACRO_END
- */
-
- //PRINT(with, PADSIZE); \
- //PRINT(with, x); \
-
- #define PAD(howmany, with) \
- CYG_MACRO_START \
- if ((x = (howmany)) > 0) { \
- while (x > PADSIZE) { \
- if (print_back_to_string(with, PADSIZE, &n, &ret, &stream)) goto done; \
- x -= PADSIZE; \
- } \
- if (print_back_to_string(with, x, &n, &ret, &stream))goto done; \
- } \
- CYG_MACRO_END
-
- /*
- * To extend shorts properly, we need both signed and unsigned
- * argument extraction methods.
- */
-
- #define SARG() \
- (flags&QUADINT ? va_arg(arg, long long) : \
- flags&LONGINT ? va_arg(arg, long) : \
- flags&SHORTINT ? (long)(short)va_arg(arg, int) : \
- flags&SIZET ? (long)va_arg(arg, size_t) : \
- (long)va_arg(arg, int))
- #define UARG() \
- (flags&QUADINT ? va_arg(arg, unsigned long long) : \
- flags&LONGINT ? va_arg(arg, unsigned long) : \
- flags&SHORTINT ? (unsigned long)(unsigned short)va_arg(arg, int) : \
- flags&SIZET ? va_arg(arg, size_t) : \
- (unsigned long)va_arg(arg, unsigned int))
-
- xdigs = (char *) NULL; // stop compiler whinging
- fmt = (char *)format;
- ret = 0;
-
- /*
- * Scan the format for conversions (`%' character).
- */
- for (;;) {
- cp = (char *)fmt; // char pointer - set to where we begin looking from
- while ((x = ((wc = *fmt) != 0))) { // While, wc=next char and x is one while there's still chars left
- fmt += x; // increment the pointer to the char
- if (wc == '%') { // check if it's the beginning of
- fmt--; // Decrement the char pointer, actually
- break;
- }
- }
- if ((y = fmt - cp) != 0) { // y is length of string to copy out just now
- //PRINT(cp, y); // Copy macro
- if(print_back_to_string(cp, y, &n, &ret, &stream)) goto done; // Copy macro
- ret += y; // increment return chars
- }
- if ((x <= 0) || (ret >= (int)n)) // @@@ this check with n isn't good enough
- goto done;
- fmt++; /* skip over '%' */
-
- flags = 0;
- dprec = 0;
- width = 0;
- prec = -1;
- sign = '\0';
-
- rflag: ch = *fmt++;
- reswitch: switch (ch) {
- case ' ':
- /*
- * ``If the space and + flags both appear, the space
- * flag will be ignored.''
- * -- ANSI X3J11
- */
- if (!sign)
- sign = ' ';
- goto rflag;
- case '#':
- flags |= ALT;
- goto rflag;
- case '*':
- /*
- * ``A negative field width argument is taken as a
- * - flag followed by a positive field width.''
- * -- ANSI X3J11
- * They don't exclude field widths read from args.
- */
- if ((width = va_arg(arg, int)) >= 0)
- goto rflag;
- width = -width;
- /* FALLTHROUGH */
- case '-':
- flags |= LADJUST;
- goto rflag;
- case '+':
- sign = '+';
- goto rflag;
- case '.':
- if ((ch = *fmt++) == '*') {
- x = va_arg(arg, int);
- prec = x < 0 ? -1 : x;
- goto rflag;
- }
- x = 0;
- while (is_digit(ch)) {
- x = 10 * x + to_digit(ch);
- ch = *fmt++;
- }
- prec = x < 0 ? -1 : x;
- goto reswitch;
- case '0':
- /*
- * ``Note that 0 is taken as a flag, not as the
- * beginning of a field width.''
- * -- ANSI X3J11
- */
- flags |= ZEROPAD;
- goto rflag;
- case '1': case '2': case '3': case '4':
- case '5': case '6': case '7': case '8': case '9':
- x = 0;
- do {
- x = 10 * x + to_digit(ch);
- ch = *fmt++;
- } while (is_digit(ch));
- width = x;
- goto reswitch;
- case 'h':
- flags |= SHORTINT;
- goto rflag;
- case 'l':
- if (*fmt == 'l') {
- fmt++;
- flags |= QUADINT;
- } else {
- flags |= LONGINT;
- }
- goto rflag;
- case 'q':
- flags |= QUADINT;
- goto rflag;
- case 'c':
- *(cp = buf) = va_arg(arg, int);
- size = 1;
- sign = '\0';
- break;
- case 'D':
- flags |= LONGINT;
- /*FALLTHROUGH*/
- case 'd':
- case 'i':
- _uquad = SARG();
- #ifndef _NO_LONGLONG
- if ((quad_t)_uquad < 0)
- #else
- if ((long) _uquad < 0)
- #endif
- {
-
- _uquad = -_uquad;
- sign = '-';
- }
- base = DEC;
- goto number;
-
- case 'e':
- case 'E':
- case 'f':
- case 'g':
- case 'G':
- // Output nothing at all
- (void) va_arg(arg, double); // take off arg anyway
- cp = "";
- size = 0;
- sign = '\0';
- break;
-
- case 'n':
- #ifndef _NO_LONGLONG
- if (flags & QUADINT)
- *va_arg(arg, quad_t *) = ret;
- else
- #endif
- if (flags & LONGINT)
- *va_arg(arg, long *) = ret;
- else if (flags & SHORTINT)
- *va_arg(arg, short *) = ret;
- else if (flags & SIZET)
- *va_arg(arg, size_t *) = ret;
- else
- *va_arg(arg, int *) = ret;
- continue; /* no output */
- case 'O':
- flags |= LONGINT;
- /*FALLTHROUGH*/
- case 'o':
- _uquad = UARG();
- base = OCT;
- goto nosign;
- case 'p':
- /*
- * ``The argument shall be a pointer to void. The
- * value of the pointer is converted to a sequence
- * of printable characters, in an implementation-
- * defined manner.''
- * -- ANSI X3J11
- */
- /* NOSTRICT */
- _uquad = (unsigned long)va_arg(arg, void *);
- base = HEX;
- xdigs = (char *)"0123456789abcdef";
- flags |= HEXPREFIX;
- ch = 'x';
- goto nosign;
- case 's':
- if ((cp = va_arg(arg, char *)) == NULL)
- cp = (char *)"(null)";
- if (prec >= 0) {
- /*
- * can't use strlen; can only look for the
- * NUL in the first `prec' characters, and
- * strlen() will go further.
- */
- char *p = (char *)memchr(cp, 0, prec);
-
- if (p != NULL) {
- size = p - cp;
- if (size > prec)
- size = prec;
- } else
- size = prec;
- } else
- size = strlen(cp);
- sign = '\0';
- break;
- case 'U':
- flags |= LONGINT;
- /*FALLTHROUGH*/
- case 'u':
- _uquad = UARG();
- base = DEC;
- goto nosign;
- case 'X':
- xdigs = (char *)"0123456789ABCDEF";
- goto hex;
- case 'x':
- xdigs = (char *)"0123456789abcdef";
- hex: _uquad = UARG();
- base = HEX;
- /* leading 0x/X only if non-zero */
- if (flags & ALT && _uquad != 0)
- flags |= HEXPREFIX;
-
- /* unsigned conversions */
- nosign: sign = '\0';
- /*
- * ``... diouXx conversions ... if a precision is
- * specified, the 0 flag will be ignored.''
- * -- ANSI X3J11
- */
- number: if ((dprec = prec) >= 0)
- flags &= ~ZEROPAD;
-
- /*
- * ``The result of converting a zero value with an
- * explicit precision of zero is no characters.''
- * -- ANSI X3J11
- */
- cp = buf + BUF;
- if (_uquad != 0 || prec != 0) {
- /*
- * Unsigned mod is hard, and unsigned mod
- * by a constant is easier than that by
- * a variable; hence this switch.
- */
- switch (base) {
- case OCT:
- do {
- *--cp = to_char(_uquad & 7);
- _uquad >>= 3;
- } while (_uquad);
- /* handle octal leading 0 */
- if (flags & ALT && *cp != '0')
- *--cp = '0';
- break;
-
- case DEC:
- if (!(flags & QUADINT)) {
- /* many numbers are 1 digit */
- unsigned long v = (unsigned long)_uquad;
- while (v >= 10) {
- /* The following is usually faster than using a modulo */
- unsigned long next = v / 10;
- *--cp = to_char(v - (next * 10));
- v = next;
- }
- *--cp = to_char(v);
- }
- else {
- while (_uquad >= 10) {
- /* The following is usually faster than using a modulo */
- u_quad_t next = _uquad / 10;
- *--cp = to_char(_uquad - (next * 10));
- _uquad = next;
- }
- *--cp = to_char(_uquad);
- }
- break;
-
- case HEX:
- do {
- *--cp = xdigs[_uquad & 15];
- _uquad >>= 4;
- } while (_uquad);
- break;
-
- default:
- cp = (char *)"bug in vfprintf: bad base";
- size = strlen(cp);
- goto skipsize;
- }
- }
- size = buf + BUF - cp;
- skipsize:
- break;
- case 'z':
- flags |= SIZET;
- goto rflag;
- default: /* "%?" prints ?, unless ? is NUL */
- if (ch == '\0')
- goto done;
- /* pretend it was %c with argument ch */
- cp = buf;
- *cp = ch;
- size = 1;
- sign = '\0';
- break;
- }
-
- /*
- * All reasonable formats wind up here. At this point, `cp'
- * points to a string which (if not flags&LADJUST) should be
- * padded out to `width' places. If flags&ZEROPAD, it should
- * first be prefixed by any sign or other prefix; otherwise,
- * it should be blank padded before the prefix is emitted.
- * After any left-hand padding and prefixing, emit zeroes
- * required by a decimal [diouxX] precision, then print the
- * string proper, then emit zeroes required by any leftover
- * floating precision; finally, if LADJUST, pad with blanks.
- *
- * Compute actual size, so we know how much to pad.
- * fieldsz excludes decimal prec; realsz includes it.
- */
- #ifdef CYGSEM_LIBC_STDIO_PRINTF_FLOATING_POINT
- fieldsz = size + fpprec;
- #else
- fieldsz = size;
- #endif
- if (sign)
- fieldsz++;
- else if (flags & HEXPREFIX)
- fieldsz+= 2;
- realsz = dprec > fieldsz ? dprec : fieldsz;
-
- /* right-adjusting blank padding */
- if ((flags & (LADJUST|ZEROPAD)) == 0) {
- if (width - realsz > 0) {
- PAD(width - realsz, blanks);
- ret += width - realsz;
- }
- }
-
- /* prefix */
- if (sign) {
- //PRINT(&sign, 1);
- if(print_back_to_string(&sign, 1, &n, &ret, &stream))goto done;
- ret++;
- } else if (flags & HEXPREFIX) {
- ox[0] = '0';
- ox[1] = ch;
- //PRINT(ox, 2);
- if(print_back_to_string(ox, 2, &n, &ret, &stream))goto done;
- ret += 2;
- }
-
- /* right-adjusting zero padding */
- if ((flags & (LADJUST|ZEROPAD)) == ZEROPAD) {
- if (width - realsz > 0) {
- PAD(width - realsz, zeroes);
- ret += width - realsz;
- }
- }
-
- if (dprec - fieldsz > 0) {
- /* leading zeroes from decimal precision */
- PAD(dprec - fieldsz, zeroes);
- ret += dprec - fieldsz;
- }
-
- /* the string or number proper */
- //PRINT(cp, size);
- if(print_back_to_string(cp,size, &n, &ret, &stream))goto done;
- ret += size;
-
- #ifdef CYGSEM_LIBC_STDIO_PRINTF_FLOATING_POINT
- /* trailing f.p. zeroes */
- PAD(fpprec, zeroes);
- ret += fpprec;
- #endif
-
- /* left-adjusting padding (always blank) */
- if (flags & LADJUST) {
- if (width - realsz > 0) {
- PAD(width - realsz, blanks);
- ret += width - realsz;
- }
- }
-
- }
-
- done:
- error:
- return ret;// remove this error stuff (((Cyg_OutputStream *) stream)->get_error() ? EOF : ret);
- /* NOTREACHED */
- }
- int
- sprintf(char* str, const char *fmt, ...)
- {
- va_list args;
-
- va_start(args, fmt);
- return vfnprintf(str, 1024, fmt, args);
-
- }
- #include "printf.h"
- #include "cpu-utils.h"
- // Actual printf function we call, with static buffer of 512 bytes
- char PRINTFBUFFER[PRINTFBUFFER_SIZE]; // Declare a global printf buffer
- int
- printf_to_sim(const char *fmt, ...)
- {
- va_list args;
- va_start(args, fmt);
-
- int str_l = vfnprintf(PRINTFBUFFER, PRINTFBUFFER_SIZE, fmt, args);
-
- if (!str_l) return -1; // no length string - just return
- char c;
- int i=0;
- while(i<str_l) sim_putc(PRINTFBUFFER[i++]);
-
- va_end(args);
- return str_l;
- }
- int
- puts_to_sim(const char *str)
- {
- return printf_to_sim("%s\n", str);
- }
- // Calls to the UART driver are always in the library - hence it is always
- // required to compile everything.
- #include "uart.h"
- int
- printf_to_uart(const char *fmt, ...)
- {
- va_list args;
- va_start(args, fmt);
-
- int str_l = vfnprintf(PRINTFBUFFER, PRINTFBUFFER_SIZE, fmt, args);
-
- if (!str_l) return -1; // no length string - just return
- // Assumes uart is initialised
- int i=0;while(i<str_l) uart_putc(DEFAULT_UART,PRINTFBUFFER[i++]);
- va_end(args);
- return str_l;
-
- }
- int
- putchar_to_uart(int c)
- {
- printf_to_uart("%c",c);
-
- return c;
- }
- int
- puts_to_uart(const char *str)
- {
- return printf_to_uart("%s\n", str);
- }
- // EOF printf.c