printf.c

ADAM2 sources (modified by Oleg)

/*-----------------------------------------------------------------------------*/
/*                                                                             */
/*   Copyright (C) 1996-2003 by Texas Instruments, Inc.  All rights reserved.  */
/*   Copyright (C) 2001-2003 Telogy Networks, Inc.							   */
/*                                                                             */
/*     IMPORTANT - READ CAREFULLY BEFORE PROCEEDING TO USE SOFTWARE.           */
/*                                                                             */
/*  This document is displayed for you to read prior to using the software     */
/*  and documentation.  By using the software and documentation, or opening    */
/*  the sealed packet containing the software, or proceeding to download the   */
/*  software from a Bulletin Board System(BBS) or a WEB Server, you agree to   */
/*  abide by the following Texas Instruments License Agreement. If you choose  */
/*  not to agree with these provisions, promptly discontinue use of the        */
/*  software and documentation and return the material to the place you        */
/*  obtained it.                                                               */
/*                                                                             */
/*                               *** NOTE ***                                  */
/*                                                                             */
/*  The licensed materials contain MIPS Technologies, Inc. confidential        */
/*  information which is protected by the appropriate MIPS Technologies, Inc.  */
/*  license agreement.  It is your responsibility to comply with these         */
/*  licenses.                                                                  */
/*                                                                             */
/*                   Texas Instruments License Agreement                       */
/*                                                                             */
/*  1. License - Texas Instruments (hereinafter "TI"), grants you a license    */
/*  to use the software program and documentation in this package ("Licensed   */
/*  Materials") for Texas Instruments broadband products.                      */
/*                                                                             */
/*  2. Restrictions - You may not reverse-assemble or reverse-compile the      */
/*  Licensed Materials provided in object code or executable format.  You may  */
/*  not sublicense, transfer, assign, rent, or lease the Licensed Materials    */
/*  or this Agreement without written permission from TI.                      */
/*                                                                             */
/*  3. Copyright - The Licensed Materials are copyrighted. Accordingly, you    */
/*  may either make one copy of the Licensed Materials for backup and/or       */
/*  archival purposes or copy the Licensed Materials to another medium and     */
/*  keep the original Licensed Materials for backup and/or archival purposes.  */
/*                                                                             */
/*  4. Runtime and Applications Software - You may create modified or          */
/*  derivative programs of software identified as Runtime Libraries or         */
/*  Applications Software, which, in source code form, remain subject to this  */
/*  Agreement, but object code versions of such derivative programs are not    */
/*  subject to this Agreement.                                                 */
/*                                                                             */
/*  5. Warranty - TI warrants the media to be free from defects in material    */
/*  and workmanship and that the software will substantially conform to the    */
/*  related documentation for a period of ninety (90) days after the date of   */
/*  your purchase. TI does not warrant that the Licensed Materials will be     */
/*  free from error or will meet your specific requirements.                   */
/*                                                                             */
/*  6. Remedies - If you find defects in the media or that the software does   */
/*  not conform to the enclosed documentation, you may return the Licensed     */
/*  Materials along with the purchase receipt, postage prepaid, to the         */
/*  following address within the warranty period and receive a refund.         */
/*                                                                             */
/*  TEXAS INSTRUMENTS                                                          */
/*  Application Specific Products, MS 8650                                     */
/*  c/o ADAM2 Application Manager                                              */
/*  12500 TI Boulevard                                                         */
/*  Dallas, TX 75243  - U.S.A.                                                 */
/*                                                                             */
/*  7. Limitations - TI makes no warranty or condition, either expressed or    */
/*  implied, including, but not limited to, any implied warranties of          */
/*  merchantability and fitness for a particular purpose, regarding the        */
/*  licensed materials.                                                        */
/*                                                                             */
/*  Neither TI nor any applicable licensor will be liable for any indirect,    */
/*  incidental or consequential damages, including but not limited to loss of  */
/*  profits.                                                                   */
/*                                                                             */
/*  8. Term - The license is effective until terminated.   You may terminate   */
/*  it at any other time by destroying the program together with all copies,   */
/*  modifications and merged portions in any form. It also will terminate if   */
/*  you fail to comply with any term or condition of this Agreement.           */
/*                                                                             */
/*  9. Export Control - The re-export of United States origin software and     */
/*  documentation is subject to the U.S. Export Administration Regulations or  */
/*  your equivalent local regulations. Compliance with such regulations is     */
/*  your responsibility.                                                       */
/*                                                                             */
/*                         *** IMPORTANT NOTICE ***                            */
/*                                                                             */
/*  Texas Instruments (TI) reserves the right to make changes to or to         */
/*  discontinue any semiconductor product or service identified in this        */
/*  publication without notice. TI advises its customers to obtain the latest  */
/*  version of the relevant information to verify, before placing orders,      */
/*  that the information being relied upon is current.                         */
/*                                                                             */
/*  TI warrants performance of its semiconductor products and related          */
/*  software to current specifications in accordance with TI's standard        */
/*  warranty. Testing and other quality control techniques are utilized to     */
/*  the extent TI deems necessary to support this warranty. Unless mandated    */
/*  by government requirements, specific testing of all parameters of each     */
/*  device is not necessarily performed.                                       */
/*                                                                             */
/*  Please be aware that Texas Instruments products are not intended for use   */
/*  in life-support appliances, devices, or systems. Use of a TI product in    */
/*  such applications without the written approval of the appropriate TI       */
/*  officer is prohibited. Certain applications using semiconductor devices    */
/*  may involve potential risks of injury, property damage, or loss of life.   */
/*  In order to minimize these risks, adequate design and operating            */
/*  safeguards should be provided by the customer to minimize inherent or      */
/*  procedural hazards. Inclusion of TI products in such applications is       */
/*  understood to be fully at the risk of the customer using TI devices or     */
/*  systems.                                                                   */
/*                                                                             */
/*  TI assumes no liability for TI applications assistance, customer product   */
/*  design, software performance, or infringement of patents or services       */
/*  described herein. Nor does TI warrant or represent that license, either    */
/*  expressed or implied, is granted under any patent right, copyright, mask   */
/*  work right, or other intellectual property right of TI covering or         */
/*  relating to any combination, machine, or process in which such             */
/*  semiconductor products or services might be or are used.                   */
/*                                                                             */
/*  All company and/or product names are trademarks and/or registered          */
/*  trademarks of their respective manaufacturers.                             */
/*                                                                             */
/*-----------------------------------------------------------------------------*/
/*																			   */
/*  Filename : printf.c												   	   	   */
/*																			   */	
/*  Description:															   */	
/*      Alternate sys_printf routines									  	   */
/*																			   */
/*  Revision history:														   */
/*      5 Jun91...Original version..........................Graham Short	   */	
/*      Butchered...........................................Mike Denio		   */	
/*-----------------------------------------------------------------------------*/                      

#include "_stdio.h"
#include "_stdarg.h"
#include "sio.h"
#include "support.h"
                      
/* REPLACE THIS MACRO                                                        */
void (*_PrintfOutStr)(char *) = SioOutStr;

#define  MAX_STRING_SIZE    162
#define  MAX_DIGIT_SIZE     64

#define  LEFT_JUSTIFIED 0x0001
#define  SIGNED         0x0002
#define  SPACE          0x0004
#define  ALTERNATE      0x0008
#define  LEADING_ZERO   0x0010
#define  PRECISION      0x0020
#define  SHORT_INT      0x0040
#define  LONG_INT       0x0080
#define  LONG_DOUBLE    0x0100
#define  UNSIGNED       0x0200

static int _int2str
(
    long  val,
    char  *buffer,
    int   width,
    int   precision,
    int   flag,
    char  type
)
{
   char          *ptr;
   char          *ptr2   = buffer;
   char          *bufend = &buffer[MAX_DIGIT_SIZE];
   int           negative = FALSE;
   char          ch=0;
   long          digit;
   unsigned long tmp;
   int           base=0;
   unsigned long uval;

   /* point to the end of the buffer */
   ptr = bufend;
   uval = val;         

   /* fill up the buffer with digits from the right */
   switch (type)
   {
      case 'd':   
      case 'i':   if (val < 0)
                  {
                     negative = TRUE;
                     uval     = -val;
                  }
      case 'u':   base = 10;           break;
      case 'o':   base = 8;            break;
      case 'x':   base = 16; ch = 'a'; break;
      case 'p':
      case 'X':   base = 16; ch = 'A'; break;
   }

   /* Convert short hex values to 16 bit                                     */
   if( (base==16) && !(flag&LONG_INT) )
        uval &= 0x0ffffffffl;

   while (uval)
   {
      tmp = uval / base;
      digit = uval - (tmp * base);
      *--ptr = (digit > 9) ? digit - 10 + ch : digit + '0';
      uval = tmp;
   }

   /* if we've not reached precision digits, pad with 0s */
   if (!(flag & PRECISION))
      precision = 1; /* default precision if not explicitly specified is 1 */
   precision -= bufend - ptr;
   if ((flag & ALTERNATE) && (type == 'o'))
      precision = 1; /* force a leading 0 */
   if (precision > 0)
   {
      while (precision--)
         *--ptr = '0';
   }

   if ((flag & ALTERNATE) && (type == 'x'))
   {
      *--ptr = 'x';
      *--ptr = '0';
   }
   else
   if ((flag & ALTERNATE) && (type == 'X'))
   {
      *--ptr = 'X';
      *--ptr = '0';
   }
   /* set sign or space prefix */
   if (negative)
      *--ptr = '-';
   else
   if (flag & SIGNED)
      *--ptr = '+';
   else
   if (flag & SPACE)
      *--ptr = ' ';

   if (flag & LEFT_JUSTIFIED)
   {
      /* copy the string to the start of the buffer */
      while(ptr < bufend)
         *ptr2++ = *ptr++;

      /* if larger width required, pad with spaces */
      width -= ptr2 - buffer;
      if (width > 0)
      {
         while (width--)
            *ptr2++ = ' ';
      }
   }
   else
   {
      ptr2 = buffer;
      /* if larger width required, pad with spaces or 0s */
      width -= bufend - ptr;
      if (width > 0)
      {
         if ((flag & LEADING_ZERO) && (!(flag & PRECISION)))
         {
            ch = '0';
            /* copy any sign prior to 0 filling */