stdio.cpp

   1 #include "stdio.h"
   2
   3 extern int at91_dbgu_putc(int ch);
   4
   5 FILE *stdout = (FILE *)0;
   6 FILE *stdin = (FILE *)0;
   7
   8 FILE __filedesc[FILEDESCS];
   9
  10 FILE *fopen(int (*put)(int), int (*get)())
  11 {
  12   static int init = 1;
  13
  14   if(init != 0)
  15     {
  16       for(int i = 0; i < FILEDESCS; i++)
  17         {
  18           __filedesc[i].active = false;
  19           __filedesc[i].put = 0;
  20           __filedesc[i].get = 0;
  21         }
  22
  23       init = 0;
  24     }
  25
  26   for(int i = 0; i < FILEDESCS; i++)
  27     {
  28       if(!__filedesc[i].active)
  29         {
  30           __filedesc[i].put = put;
  31           __filedesc[i].get = get;
  32
  33           __filedesc[i].active = true;
  34
  35           return &__filedesc[i];
  36         }
  37     }
  38
  39   return (FILE *)0;
  40 }
  41
  42 int fclose(FILE *fp)
  43 {
  44   for(int i = 0; i < FILEDESCS; i++)
  45     if(&__filedesc[i] == fp || fp->active)
  46       {
  47         fp->active = false;
  48
  49         fp->put = 0;
  50         fp->get = 0;
  51
  52         return 0;
  53       }
  54
  55   return -1;
  56 }
  57
  58 int fputs(const char *str, FILE *fp)
  59 {
  60   if(fp == (FILE *)0)
  61     return -1;
  62
  63   if(fp->put == (void *)0)
  64     return -1;
  65
  66   while(*str != 0)
  67     {
  68       fp->put(*str);
  69       str++;
  70     }
  71   return 0;
  72 }
  73
  74 int fputc(int c, FILE *fp)
  75 {
  76   if(fp == (FILE *)0)
  77     return -1;
  78
  79   if(fp->put == (void *)0)
  80     return -1;
  81
  82   return fp->put(c);
  83 }
  84
  85 int fgetc(FILE *fp)
  86 {
  87   if(fp == (FILE *)0)
  88     return -1;
  89
  90   if(fp->get == (void *)0)
  91     return -1;
  92
  93   return fp->get();
  94 }
  95
  96
  97 int puts(const char *str)
  98 {
  99   return fputs(str, stdout);
 100 }
 101
 102 int putc(int c)
 103 {
 104   return fputc(c, stdout);
 105 }
 106
 107 int putchar(int c)
 108 {
 109   return fputc(c, stdout);
 110 }
 111
 112 int getc()
 113 {
 114   return fgetc(stdin);
 115 }
 116
 117 int strlen(const char *str)
 118 {
 119   int len = 0;
 120
 121   if(str == (char *)0)
 122     return 0;
 123
 124   while(*str++ != 0)
 125     len++;
 126
 127   return len;
 128 }
 129
 130 #define ZEROPAD 1               /* pad with zero */
 131 #define SIGN    2               /* unsigned/signed long */
 132 #define LEFT    4              /* left justified */
 133 #define LARGE   8              /* use 'ABCDEF' instead of 'abcdef' */
 134
 135 #define do_div(n,base) ({ \
 136         int __res; \
 137         __res = ((unsigned) n) % (unsigned) base; \
 138         n = ((unsigned) n) / (unsigned) base; \
 139         __res; \
 140 })
 141
 142 int number(FILE *fp, int num, int base, int size, int precision, int type)
 143 {
 144   char c, sign, tmp[66];
 145   const char *digits="0123456789abcdef";
 146   int i;
 147
 148   if (type & LARGE)
 149     digits = "0123456789ABCDEF";
 150   if (type & LEFT)
 151     type &= ~ZEROPAD;
 152   if (base < 2 || base > 16)
 153     return 0;
 154   c = (type & ZEROPAD) ? '0' : ' ';
 155   sign = 0;
 156
 157   if(type & SIGN && num < 0)
 158     {
 159       sign = '-';
 160       num = -num;
 161       size--;
 162     }
 163
 164   i = 0;
 165   if(num == 0)
 166     tmp[i++] = digits[0];
 167   else while(num != 0)
 168     tmp[i++] = digits[do_div(num, base)];
 169
 170   if(i > precision)
 171     precision = i;
 172   size -= precision;
 173
 174   if(!(type&(ZEROPAD+LEFT)))
 175     while(size-->0)
 176       fputc(' ', fp);
 177
 178   if(sign)
 179     fputc(sign, fp);
 180
 181   if (!(type & LEFT))
 182     while (size-- > 0)
 183       fputc(c, fp);
 184
 185   while (i < precision--)
 186     fputc('0', fp);
 187
 188   while (i-- > 0)
 189     fputc(tmp[i], fp);
 190
 191   while (size-- > 0)
 192     fputc(' ', fp);;
 193
 194   return 1;
 195 }
 196
 197 int vfprintf(FILE *fp, const char *fmt, va_list va)
 198 {
 199   char *s;
 200
 201   do
 202     {
 203       if(*fmt == '%')
 204         {
 205           bool done = false;
 206
 207           int type = 0;
 208           int precision = 0;
 209
 210           do
 211             {
 212               fmt++;
 213               switch(*fmt)
 214                 {
 215                 case '0' :
 216                   if(!precision)
 217                     type |= ZEROPAD;
 218                 case '1' :
 219                 case '2' :
 220                 case '3' :
 221                 case '4' :
 222                 case '5' :
 223                 case '6' :
 224                 case '7' :
 225                 case '8' :
 226                 case '9' :
 227                   precision = precision * 10 + (*fmt - '0');
 228                   break;
 229                 case '.' :
 230                   break;
 231                 case 's' :
 232                   s = va_arg(va, char *);
 233                   if(!s)
 234                     fputs("<NULL>", fp);
 235                   else
 236                     fputs(s, fp);
 237                   done = true;
 238                   break;
 239                 case 'c' :
 240                   fputc(va_arg(va, int), fp);
 241                   done = true;
 242                   break;
 243                 case 'd' :
 244                   number(fp, va_arg(va, int), 10, 0, precision, type);
 245                   done = true;
 246                   break;
 247                 case 'x' :
 248                   number(fp, va_arg(va, int), 16, 0, precision, type);
 249                   done = true;
 250                   break;
 251                 case 'X' :
 252                   number(fp, va_arg(va, int), 16, 0, precision, type | LARGE);
 253                   done = true;
 254                   break;
 255                 case '%' :
 256                   fputc(*fmt, fp);
 257                   done = true;
 258                 default:
 259                   fputc('%', fp);
 260                   fputc(*fmt, fp);
 261                   done = true;
 262                   break;
 263                 }
 264             }
 265           while(!done);
 266         }
 267       else
 268         fputc(*fmt, fp);
 269
 270       fmt++;
 271     }
 272   while(*fmt != 0);
 273
 274   return 0;
 275 }
 276
 277 int fprintf(FILE *fp, const char *fmt, ...)
 278 {
 279   va_list ap;
 280   int i;
 281
 282   va_start(ap, fmt);
 283   i = fprintf(fp, fmt, ap);
 284   va_end(ap);
 285
 286   return i;
 287 }
 288
 289 int printf(const char *fmt, ...)
 290 {
 291   va_list ap;
 292   int i;
 293
 294   va_start(ap, fmt);
 295   i = vfprintf(stdout, fmt, ap);
 296   va_end(ap);
 297
 298   return i;
 299 }