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

Subversion Repositories openrisc

[/] [openrisc/] [trunk/] [orpsocv2/] [sw/] [lib/] [printf.c] - Diff between revs 485 and 489

Go to most recent revision | Only display areas with differences | Details | Blame | View Log

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

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.