freeldr/freeldr/rtl/print.c

   1 /*
   2  *  FreeLoader
   3  *  Copyright (C) 1998-2002  Brian Palmer  <brianp@sginet.com>
   4  *
   5  *  This program is free software; you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation; either version 2 of the License, or
   8  *  (at your option) any later version.
   9  *
  10  *  This program is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with this program; if not, write to the Free Software
  17  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18  */
  19
  20 #include <rtl.h>
  21
  22 /*
  23  * print() - prints unformatted text to stdout
  24  */
  25 void print(char *str)
  26 {
  27         int     i;
  28
  29         for(i=0; i<strlen(str); i++)
  30                 putchar(str[i]);
  31 }
  32
  33 /*
  34  * printf() - prints formatted text to stdout
  35  * originally from GRUB
  36  */
  37 void printf(char *format, ... )
  38 {
  39         int *dataptr = (int *) &format;
  40         char c, *ptr, str[16];
  41
  42         dataptr++;
  43
  44         while ((c = *(format++)))
  45         {
  46                 if (c != '%')
  47                 {
  48                         putchar(c);
  49                 }
  50                 else
  51                 {
  52                         c = *(format++);
  53                         if (c == 'l')
  54                         {
  55                                 c = *(format++);
  56                         }
  57
  58                         switch (c)
  59                         {
  60                         case 'd': case 'u': case 'x':
  61                                 *convert_to_ascii(str, c, *((unsigned long *) dataptr++)) = 0;
  62
  63                                 ptr = str;
  64
  65                                 while (*ptr)
  66                                 {
  67                                         putchar(*(ptr++));
  68                                 }
  69                                 break;
  70
  71                         case 'c': putchar((*(dataptr++))&0xff); break;
  72
  73                         case 's':
  74                                 ptr = (char *)(*(dataptr++));
  75
  76                                 while ((c = *(ptr++)))
  77                                 {
  78                                         putchar(c);
  79                                 }
  80                                 break;
  81                         }
  82                 }
  83         }
  84 }
  85
  86 void sprintf(char *buffer, char *format, ... )
  87 {
  88         int *dataptr = (int *) &format;
  89         char c, *ptr, str[16];
  90         char *p = buffer;
  91
  92         dataptr++;
  93
  94         while ((c = *(format++)))
  95         {
  96                 if (c != '%')
  97                 {
  98                         *p = c;
  99                         p++;
 100                 }
 101                 else
 102                 {
 103                         c = *(format++);
 104                         if (c == 'l')
 105                         {
 106                                 c = *(format++);
 107                         }
 108
 109                         switch (c)
 110                         {
 111                         case 'd': case 'u': case 'x':
 112                                 *convert_to_ascii(str, c, *((unsigned long *) dataptr++)) = 0;
 113
 114                                 ptr = str;
 115
 116                                 while (*ptr)
 117                                 {
 118                                 *p = *(ptr++);
 119                                 p++;
 120                                 }
 121                                 break;
 122
 123                         case 'c':
 124                                 *p = (*(dataptr++))&0xff;
 125                                 p++;
 126                                 break;
 127
 128                         case 's':
 129                                 ptr = (char *)(*(dataptr++));
 130
 131                                 while ((c = *(ptr++)))
 132                                 {
 133                                 *p = c;
 134                                 p++;
 135                                 }
 136                                 break;
 137                         }
 138                 }
 139         }
 140         *p=0;
 141 }