* device/include/pic16/stdio.h, device/lib/pic16/libc/stdio/streams.c,
[fw/sdcc] / device / lib / pic16 / libc / stdio / printf_tiny.c
index d700b3f0a4c7a8d7b9bde03ba5d9844163ac88cc..f88bb36da707a5c79f03965fbc1e2756f0534c22 100644 (file)
@@ -2,7 +2,7 @@
     printf_tiny.c - source file for reduced version of printf
 
     Modified for pic16 port, by Vangelis Rokas, 2004 (vrokas@otenet.gr)
-    
+
     Written By - Sandeep Dutta . sandeep.dutta@usa.net (1999)
 
     This library is free software; you can redistribute it and/or modify it
     In other words, you are welcome to use, share and improve this program.
     You are forbidden to forbid anyone else to use, share and improve
     what you give them.   Help stamp out software-hoarding!
--------------------------------------------------------------------------*/
 
-/*
-** $Id$
-*/
+   As a special exception, if you link this library with other files,
+   some of which are compiled with SDCC, to produce an executable,
+   this library does not by itself cause the resulting executable
+   to be covered by the GNU General Public License.
+   This exception does not however invalidate any other reasons why
+   the executable file might be covered by the GNU General Public License.
+-------------------------------------------------------------------------*/
 
 /* This function uses function putchar() to dump a character
  * to standard output. putchar() is defined in libc18f.lib
 
 /* following formats are supported :-
    format     output type       argument-type
+     %u*       unsigned            *
+
+     %b        binary
      %d        decimal             int
      %ld       decimal             long
      %hd       decimal             char
      %x        hexadecimal         int
-     %lx       hexadecimal         long
-     %hx       hexadecimal         char
+     %lxX      hexadecimal         long
+     %hxX      hexadecimal         char
      %o        octal               int
      %lo       octal               long
      %ho       octal               char
      %s        character           generic pointer
 */
 
+/*
+ * This macro enables the use of the 'b' binary specifier and
+ * the use of "%b", "%hb" and "%lb"
+ */
+/* #define BINARY_SPECIFIER */
+
+#include <ctype.h>
 #include <stdarg.h>
 #include <stdio.h>
 #include <stdlib.h>
 
-void printf_tiny(char *fmt, ...) 
+#if 0
+#define DPUT(c) putchar(c)
+#else
+#define DPUT(c)
+#endif
+
+#define ISLONG          (flong)
+#define ISSTR           (fstr)
+#define ISCHAR          (fchar)
+#define HAVESIGN        (nosign)
+
+
+#if 1
+extern void io_long (long);
+extern void io_int (long);
+extern void io_char (char);
+#endif
+
+void
+printf_tiny (const char *fmt, ...)
 {
-  char *ch;
   char radix;
-  char flong;
-  char fstr;
-  char fchar;
-  char *str;
-  data char *str1;
+  char flong, fstr;
+  char fchar, nosign;
+  char upcase;
+
+  char *str, *ch;
+  __data char *str1;
   long val;
-//  static
-  char buffer[35];
-  va_list ap ;
+//  static char buffer[16];
+  char buffer[16];
+  va_list ap;
+
+  va_start (ap, fmt);
+  ch = fmt;
 
-    ch = fmt;
-    va_start(ap,fmt);
+  while (*ch) //for (; *fmt ; fmt++ )
+    {
+      if (*ch == '%')
+        {
+          ISLONG = 0;
+          ISSTR = 0;
+          ISCHAR = 0;
+          HAVESIGN = 0;
+          radix = 0;
+          upcase = 0;
+          ch++;
 
-    while( *ch ) {                     //for (; *fmt ; fmt++ )
-        if (*ch == '%') {
-            flong = fstr = fchar = 0;
+          if (*ch == 'u')
+            {
+              HAVESIGN = 1;
+              ++ch;
+            }
+
+          if (*ch == 'l')
+            {
+              ISLONG = 1;
+              ++ch;
+            }
+          else if (*ch == 'h')
+            {
+              ISCHAR = 1;
+              ++ch;
+            }
+
+          if (*ch == 's')
+            ISSTR = 1;
+          else if (*ch == 'd')
+            radix = 10;
+          else if (*ch == 'x')
+            {
+              radix = 16;
+              upcase = 0;
+            }
+          else if (*ch == 'X')
+            {
+              radix = 16;
+              upcase = 1;
+            }
+          else if (*ch == 'c')
             radix = 0;
-            ch++;
-
-            if(*ch == 'l') {
-              flong = 1;
-              ch++;
-            } else
-            if(*ch == 'h') {
-              fchar = 1;
-              ch++;
+          else if (*ch == 'o')
+            radix = 8;
+#ifdef BINARX_SPECIFIER
+          else if (*ch == 'b')
+            radix = 2;
+#endif
+
+          if (ISSTR)
+            {
+              str = va_arg (ap, char *);
+              while (*str)
+                {
+                  putchar (*str);
+                  ++str;
+                }
             }
-            
-            if(*ch == 's')fstr = 1;
-            else if(*ch == 'd')radix = 10;
-            else if(*ch == 'x')radix = 16;
-            else if(*ch == 'c')radix = 0;
-            else if(*ch == 'o')radix = 8;
-            
-            if(fstr) {
-                str = va_arg(ap, char *);
-                while (*str) putchar(*str++);
-            } else {
-              if(flong)val = va_arg(ap, long);
+          else
+            {
+              if (ISLONG)
+                val = va_arg (ap, long);
+              else if (ISCHAR)
+                {
+                  val = (unsigned char) va_arg (ap, int);       // FIXME: SDCC casts char arguments into ints
+                  if (!HAVESIGN)
+                    val = (char) val;   // FIXME cont'd: sign-extend if required
+                }
               else
-              if(fchar)val = va_arg(ap, char);
-              else {
-                  val = va_arg(ap, int);
-              }
-            
-              if(radix) {
-                ltoa (val, buffer, radix);
-
-                str1 = buffer;
-                while ( *str1 ) {
-                  putchar ( *str1++ );
+                val = va_arg (ap, int);
+
+              if (radix)
+                {
+                  if (HAVESIGN)
+                    ultoa (val, buffer, radix);
+                  else
+                    ltoa (val, buffer, radix);
+
+                  str1 = buffer;
+                  while ((*str1))
+                    {
+                      radix = *str1;
+                      if (upcase)
+                        radix = toupper (radix);
+                      putchar (radix);
+                      ++str1;
+                    }
                 }
-              }        else
-                putchar((char)val);
+              else
+                putchar ((char) val);
             }
-          } else
-            putchar(*ch);
+        }
+      else
+        putchar (*ch);
 
-        ch++;
+      ++ch;
     }
 }