Subversion Repositories amber

/*----------------------------------------------------------------
//                                                              //
//  sprintf.c                                                   //
//                                                              //
//  This file is part of the Amber project                      //
//  http://www.opencores.org/project,amber                      //
//                                                              //
//  Description                                                 //
//  printf functions for the mini-libc library.                 //
//                                                              //
//  Author(s):                                                  //
//      - Conor Santifort, csantifort.amber@gmail.com           //
//                                                              //
//////////////////////////////////////////////////////////////////
//                                                              //
// Copyright (C) 2011 Authors and OPENCORES.ORG                 //
//                                                              //
// This source file may be used and distributed without         //
// restriction provided that this copyright statement is not    //
// removed from the file and that any derivative work contains  //
// the original copyright notice and the associated disclaimer. //
//                                                              //
// This source file is free software; you can redistribute it   //
// and/or modify it under the terms of the GNU Lesser General   //
// Public License as published by the Free Software Foundation; //
// either version 2.1 of the License, or (at your option) any   //
// later version.                                               //
//                                                              //
// This source 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 Lesser General Public License for more //
// details.                                                     //
//                                                              //
// You should have received a copy of the GNU Lesser General    //
// Public License along with this source; if not, download it   //
// from http://www.opencores.org/lgpl.shtml                     //
//                                                              //
----------------------------------------------------------------*/
 
#include "stdio.h"
 
/* Defines */
#define PAD_RIGHT 1
#define PAD_ZERO  2
 
/* the following should be enough for 32 bit int */
#define PRINT_BUF_LEN 16
 
 
/* format and print a string, inserting variables, to dst char buffer,
   return the number of characters printed. If dst is 0, the string is
   sent to the serial output
*/
int print(char** dst, const char *format, unsigned long *varg)
{
    register int width, pad;
    register int pc = 0;
    char scr[2];
 
    for (; *format != 0; ++format) {
       if (*format == '%') {
          ++format;
          width = pad = 0;
          if (*format == '\0') break;
          if (*format == '%') goto out;
          if (*format == '-') {
             ++format;
             pad = PAD_RIGHT;
          }
          while (*format == '0') {
             ++format;
             pad |= PAD_ZERO;
          }
          for ( ; *format >= '0' && *format <= '9'; ++format) {
             width *= 10;
             width += *format - '0';
          }
          if( *format == 's' ) {
             register char *s = *((char **)varg++);
             pc += prints (dst, s?s:"(null)", width, pad);
             continue;
          }
          if( *format == 'd' ) {
             pc += printi (dst, *varg++, 10, 1, width, pad, 'a');
             continue;
          }
          if( *format == 'x' ) {
             pc += printi (dst, *varg++, 16, 0, width, pad, 'a');
             continue;
          }
          if( *format == 'X' ) {
             pc += printi (dst, *varg++, 16, 0, width, pad, 'A');
             continue;
          }
          if( *format == 'u' ) {
             pc += printi (dst, *varg++, 10, 0, width, pad, 'a');
             continue;
          }
          if( *format == 'c' ) {
             /* char are converted to int then pushed on the stack */
             scr[0] = *varg++;
             scr[1] = '\0';
             pc += prints (dst, scr, width, pad);
             continue;
          }
       }
       else {
       out:
          if (dst)
              *(*dst)++ = *format;
          else
              serial_putchar_(*format);
          ++pc;
       }
    }
 
    return pc;
}
 
 
/* Print a string - no formatting characters will be interpreted here */
int prints(char** dst, const char *string, int width, int pad)
{
    register int pc = 0, padchar = ' ';
 
    if (width > 0) {
       register int len = 0;
       register const char *ptr;
       for (ptr = string; *ptr; ++ptr) ++len;
       if (len >= width) width = 0;
       else width -= len;
       if (pad & PAD_ZERO) padchar = '0';
    }
    if (!(pad & PAD_RIGHT)) {
       for ( ; width > 0; --width) {
          if (dst)
              *(*dst)++ = padchar;
          else
              serial_putchar_(padchar);
          ++pc;
       }
    }
    for ( ; *string ; ++string) {
       if (dst)
          *(*dst)++ = *string;
       else
          serial_putchar_(*string);
       ++pc;
    }
    for ( ; width > 0; --width) {
       if (dst)
          *(*dst)++ = padchar;
       else
          serial_putchar_(padchar);
       ++pc;
    }
 
    return pc;
}
 
 
/* Printf an integer */
int printi(char** dst, int i, int b, int sg, int width, int pad, int letbase)
{
    char print_buf[PRINT_BUF_LEN];
    char *s;
    int t, neg = 0, pc = 0;
    unsigned int u = i;
 
    if (i == 0) {
       print_buf[0] = '0';
       print_buf[1] = '\0';
       return prints (dst, print_buf, width, pad);
    }
 
    if (sg && b == 10 && i < 0) {
       neg = 1;
       u = -i;
    }
 
    s = print_buf + PRINT_BUF_LEN-1;
    *s = '\0';
 
    while (u) {
       if ( b == 16 )    t = u & 0xf;                  /* hex modulous */
       else              t = u - ( _div (u, b) * b );  /* Modulous */
 
       if( t >= 10 )
          t += letbase - '0' - 10;
       *--s = t + '0';
 
    /*   u /= b;  */
       if ( b == 16)  u = u >> 4;    /* divide by 16 */
       else           u = _div(u, b);
    }
 
    if (neg) {
       if( width && (pad & PAD_ZERO) ) {
          if (dst)
              *(*dst)++ = '-';
          else
              serial_putchar_('-');
          ++pc;
          --width;
       }
       else {
          *--s = '-';
       }
    }
 
    return pc + prints (dst, s, width, pad);
}