Subversion Repositories openrisc

/*

  File: cprintf_r.c

  Copyright (C) 2004  Kustaa Nyholm

  This library 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 library 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 library; if not, write to the Free Software

  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

*/

#include "cprintf_r.h"

typedef void (*putcf) (char,void*);

static putcf stdout_putf;

static void* stdout_putp;

#ifdef PRINTF_LONG_SUPPORT

static void uli2a(unsigned long int num, unsigned int base, int uc,char * bf)

{

  int n=0;

  unsigned int d=1;

  while (num/d >= base)

    d*=base;

  while (d!=0) {

    int dgt = num / d;

    num%=d;

    d/=base;

    if (n || dgt>0|| d==0) {

      *bf++ = dgt+(dgt<10 ? '0' : (uc ? 'A' : 'a')-10);

      ++n;

    }

  }

  *bf=0;

}

static void li2a (long num, char * bf)

{

  if (num<0) {

    num=-num;

    *bf++ = '-';

  }

  uli2a(num,10,0,bf);

}

#endif

static void ui2a(unsigned int num, unsigned int base, int uc,char * bf)

{

  int n=0;

  unsigned int d=1;

  while (num/d >= base)

    d*=base;

  while (d!=0) {

    int dgt = num / d;

    num%= d;

    d/=base;

    if (n || dgt>0 || d==0) {

      *bf++ = dgt+(dgt<10 ? '0' : (uc ? 'A' : 'a')-10);

      ++n;

    }

  }

  *bf=0;

}

static void i2a (int num, char * bf)

{

  if (num<0) {

    num=-num;

    *bf++ = '-';

  }

  ui2a(num,10,0,bf);

}

static int a2d(char ch)

{

  if (ch>='0' && ch<='9')

    return ch-'0';

  else if (ch>='a' && ch<='f')

    return ch-'a'+10;

  else if (ch>='A' && ch<='F')

    return ch-'A'+10;

  else return -1;

}

static char a2i(char ch, char** src,int base,int* nump)

{

  char* p= *src;

  int num=0;

  int digit;

  while ((digit=a2d(ch))>=0) {

    if (digit>base) break;

    num=num*base+digit;

    ch=*p++;

  }

  *src=p;

  *nump=num;

  return ch;

}

static void putchw(void* putp,putcf putf,int n, char z, char* bf)

{

  char fc=z? '0' : ' ';

  char ch;

  char* p=bf;

  while (*p++ && n > 0)

    n--;

  while (n-- > 0)

    putf(fc,putp);

  while ((ch= *bf++))

    putf(ch,putp);

}

void tfp_format(void* putp,putcf putf,char *fmt, va_list va)

{

  char bf[12];

  char ch;

  while ((ch=*(fmt++))) {

    if (ch!='%')

      putf(ch,putp);

    else {

      char lz=0;

#ifdef  PRINTF_LONG_SUPPORT

      char lng=0;

#endif

      int w=0;

      ch=*(fmt++);

      if (ch=='0') {

        ch=*(fmt++);

        lz=1;

      }

      if (ch>='0' && ch<='9') {

        ch=a2i(ch,&fmt,10,&w);

      }

#ifdef  PRINTF_LONG_SUPPORT

      if (ch=='l') {

        ch=*(fmt++);

        lng=1;

      }

#endif

      switch (ch) {

      case 0:

        goto abort;

      case 'u' : {

#ifdef  PRINTF_LONG_SUPPORT

        if (lng)

          uli2a(va_arg(va, unsigned long int),10,0,bf);

        else

#endif

          ui2a(va_arg(va, unsigned int),10,0,bf);

        putchw(putp,putf,w,lz,bf);

        break;

      }

      case 'd' :  {

#ifdef  PRINTF_LONG_SUPPORT

        if (lng)

          li2a(va_arg(va, unsigned long int),bf);

        else

#endif

          i2a(va_arg(va, int),bf);

        putchw(putp,putf,w,lz,bf);

        break;

      }

      case 'x': case 'X' :

#ifdef  PRINTF_LONG_SUPPORT

        if (lng)

          uli2a(va_arg(va, unsigned long int),16,(ch=='X'),bf);

        else

#endif

          ui2a(va_arg(va, unsigned int),16,(ch=='X'),bf);

        putchw(putp,putf,w,lz,bf);

        break;

      case 'c' :

        putf((char)(va_arg(va, int)),putp);

        break;

      case 's' :

        putchw(putp,putf,w,0,va_arg(va, char*));

        break;

      case '%' :

        putf(ch,putp);

      default:

        break;

      }

    }

  }

 abort:;

}

void init_printf(void* putp,void (*putf) (char,void*))

{

  stdout_putf=putf;

  stdout_putp=putp;

}

void tfp_printf(char *fmt, ...)

{

  va_list va;

  va_start(va,fmt);

  tfp_format(stdout_putp,stdout_putf,fmt,va);

  va_end(va);

}

static void putcp(char c, void* p)

{

  *(*((char**)p))++ = c;

}

void tfp_sprintf(char* s,char *fmt, ...)

{

  va_list va;

  va_start(va,fmt);

  tfp_format(&s, putcp, fmt, va);

  putcp(0,&s);

  va_end(va);

}