WebSVN – libSmallPrintf – Diff – /trunk/Src/small_printf.c

 /*
         Copyright 2001, 2002 Georges Menie (www.menie.org)
         stdarg version contributed by Christian Ettinger
-    This program is free software; you can redistribute it and/or modify
+        This program is free software; you can redistribute it and/or modify
-    it under the terms of the GNU Lesser General Public License as published by
+        it under the terms of the GNU Lesser General Public License as published by
-    the Free Software Foundation; either version 2 of the License, or
+        the Free Software Foundation; either version 2 of the License, or
-    (at your option) any later version.
+        (at your option) any later version.
-    This program is distributed in the hope that it will be useful,
+        This program is distributed in the hope that it will be useful,
-    but WITHOUT ANY WARRANTY; without even the implied warranty of
+        but WITHOUT ANY WARRANTY; without even the implied warranty of
-    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+        MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
-    GNU Lesser General Public License for more details.
+        GNU Lesser General Public License for more details.
-    You should have received a copy of the GNU Lesser General Public License
+        You should have received a copy of the GNU Lesser General Public License
-    along with this program; if not, write to the Free Software
+        along with this program; if not, write to the Free Software
-    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+        Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */
 /* Includes */
 #include "libSmallPrintf/small_printf.h"
 #include <stdarg.h>
 #include <stdio.h>
 #include <string.h>
         if you have a working putchar, leave it commented out.
         If not, uncomment the define below and
         replace outbyte(c) by your own function call.
 */
 static void printchar(char **str, int c)
+{
-        if (str) {
+        if (str)
+        {
                 **str = c;
                 ++(*str);
+        }
+#if defined SERIAL_UART1 || defined SERIAL_UART2 || defined SERIAL_UART3 || defined SERIAL_UART4
+        else
-        else (void)PutCharSerial(c);
+                (void)PutCharSerial(c);
+#endif
+}
 #define PAD_RIGHT 1
 #define PAD_ZERO 2
 static int prints(char **out, const char *string, int width, int pad)
+{
         register int pc = 0, padchar = ' ';
-        if (width > 0) {
+        if (width > 0)
+        {
                 register int len = 0;
                 register const char *ptr;
-                for (ptr = string; *ptr; ++ptr) ++len;
+                for (ptr = string; *ptr; ++ptr)
+                        ++len;
-                if (len >= width) width = 0;
+                if (len >= width)
+                        width = 0;
+                else
-                else width -= len;
+                        width -= len;
-                if (pad & PAD_ZERO) padchar = '0';
+                if (pad & PAD_ZERO)
+                        padchar = '0';
         }
-        if (!(pad & PAD_RIGHT)) {
+        if (!(pad & PAD_RIGHT))
+        {
-                for ( ; width > 0; --width) {
+                for (; width > 0; --width)
+                {
-                        printchar (out, padchar);
+                        printchar(out, padchar);
                         ++pc;
+                }
+        }
-        for ( ; *string ; ++string) {
+        for (; *string; ++string)
+        {
-                printchar (out, *string);
+                printchar(out, *string);
                 ++pc;
+        }
-        for ( ; width > 0; --width) {
+        for (; width > 0; --width)
+        {
-                printchar (out, padchar);
+                printchar(out, padchar);
                 ++pc;
+        }
         return pc;
+}
         char print_buf[PRINT_BUF_LEN];
         register char *s;
         register int t, neg = 0, pc = 0;
         register unsigned int u = i;
-        if (i == 0) {
+        if (i == 0)
+        {
                 print_buf[0] = '0';
                 print_buf[1] = '\0';
-                return prints (out, print_buf, width, pad);
+                return prints(out, print_buf, width, pad);
+        }
-        if (sg && b == 10 && i < 0) {
+        if (sg && b == 10 && i < 0)
+        {
                 neg = 1;
                 u = -i;
+        }
-        s = print_buf + PRINT_BUF_LEN-1;
+        s = print_buf + PRINT_BUF_LEN - 1;
         *s = '\0';
-        while (u) {
+        while (u)
+        {
                 t = u % b;
-                if( t >= 10 )
+                if (t >= 10)
                         t += letbase - '0' - 10;
                 *--s = t + '0';
                 u /= b;
+        }
-        if (neg) {
+        if (neg)
+        {
-                if( width && (pad & PAD_ZERO) ) {
+                if (width && (pad & PAD_ZERO))
+                {
-                        printchar (out, '-');
+                        printchar(out, '-');
                         ++pc;
                         --width;
+                }
-                else {
+                else
+                {
                         *--s = '-';
+                }
+        }
-        return pc + prints (out, s, width, pad);
+        return pc + prints(out, s, width, pad);
+}
-static int small_print(char **out, const char *format, va_list args )
+static int small_print(char **out, const char *format, va_list args)
+{
         register int width, pad;
         register int pc = 0;
         char scr[2];
-        for (; *format != 0; ++format) {
+        for (; *format != 0; ++format)
+        {
-                if (*format == '%') {
+                if (*format == '%')
+                {
                         ++format;
                         width = pad = 0;
-                        if (*format == '\0') break;
+                        if (*format == '\0')
+                                break;
-                        if (*format == '%') goto out;
+                        if (*format == '%')
+                                goto out;
-                        if (*format == '-') {
+                        if (*format == '-')
+                        {
                                 ++format;
                                 pad = PAD_RIGHT;
+                        }
-                        while (*format == '0') {
+                        while (*format == '0')
+                        {
                                 ++format;
                                 pad |= PAD_ZERO;
+                        }
                         if ('*' == *format)
+                        {
-                                width = va_arg( args, int );    // get width from next argument
+                                width = va_arg(args, int); // get width from next argument
                                 format++;
+                        }
                         else
+                        {
-                                for ( ; *format >= '0' && *format <= '9'; ++format)
+                                for (; *format >= '0' && *format <= '9'; ++format)
+                                {
                                         width *= 10;
                                         width += *format - '0';
+                                }
+                        }
+                        if (*format == 'l')
-                        if( *format == 'l') { /* skip l in ld etc */
+                        { /* skip l in ld etc */
                                 format++;
+                        }
-                        if( *format == 's' ) {
+                        if (*format == 's')
+                        {
-                                register char *s = (char *)va_arg( args, int );
+                                register char *s = (char *)va_arg(args, int);
-                                pc += prints (out, s?s:"(null)", width, pad);
+                                pc += prints(out, s ? s : "(null)", width, pad);
                                 continue;
+                        }
-                        if( *format == 'd' ) {
+                        if (*format == 'd')
+                        {
-                                pc += printi (out, va_arg( args, int ), 10, 1, width, pad, 'a');
+                                pc += printi(out, va_arg(args, int), 10, 1, width, pad, 'a');
                                 continue;
+                        }
-                        if( *format == 'x' ) {
+                        if (*format == 'x')
+                        {
-                                pc += printi (out, va_arg( args, int ), 16, 0, width, pad, 'a');
+                                pc += printi(out, va_arg(args, int), 16, 0, width, pad, 'a');
                                 continue;
+                        }
-                        if( *format == 'X' ) {
+                        if (*format == 'X')
+                        {
-                                pc += printi (out, va_arg( args, int ), 16, 0, width, pad, 'A');
+                                pc += printi(out, va_arg(args, int), 16, 0, width, pad, 'A');
                                 continue;
+                        }
-                        if( *format == 'u' ) {
+                        if (*format == 'u')
+                        {
-                                pc += printi (out, va_arg( args, int ), 10, 0, width, pad, 'a');
+                                pc += printi(out, va_arg(args, int), 10, 0, width, pad, 'a');
                                 continue;
+                        }
-                        if( *format == 'c' ) {
+                        if (*format == 'c')
+                        {
                                 /* char are converted to int then pushed on the stack */
-                                scr[0] = (char)va_arg( args, int );
+                                scr[0] = (char)va_arg(args, int);
                                 scr[1] = '\0';
-                                pc += prints (out, scr, width, pad);
+                                pc += prints(out, scr, width, pad);
                                 continue;
+                        }
-                        if( *format == 'n' )
+                        if (*format == 'n')
-                        {       /* convert number printed so far and store in *va_arg( args, int)... */
+                        { /* convert number printed so far and store in *va_arg( args, int)... */
-                                int *dp = va_arg( args, int );
+                                int *dp = va_arg(args, int);
                                 *dp = pc;
                                 continue;
+                        }
+                }
-                else {
+                else
+                {
                 out:
                         /* deal with LF -> CRLF mapping */
-                        if(*format == '\n')
+                        if (*format == '\n')
+                        {
-                                printchar(out,'\r');
+                                printchar(out, '\r');
                                 ++pc; // extra char
+                        }
-                        printchar (out, *format);
+                        printchar(out, *format);
                         ++pc;
+                }
+        }
+        if (out)
-        if (out) **out = '\0';
+                **out = '\0';
         return pc;
+}
 int small_printf(const char *format, ...)
+{
         int result = 0;
         va_list args;
-        va_start( args, format );
+        va_start(args, format);
-        result = small_print( 0, format, args );
+        result = small_print(0, format, args);
         va_end(args);
         return result;
+}
 int small_sprintf(char *out, const char *format, ...)
+{
-    int result = 0;
+        int result = 0;
-                va_list args;
+        va_list args;
-        va_start( args, format );
+        va_start(args, format);
-        result = small_print( &out, format, args );
+        result = small_print(&out, format, args);
         va_end(args);
         return result;
+}

Subversion Repositories libSmallPrintf

(root)/trunk/Src/small_printf.c – Rev 3 → 5