kconfig: Don't leak choice names during parsing
[carl9170fw.git] / carlfw / src / printf.c
1 /*
2  * Copyright (C) 2004,2008  Kustaa Nyholm
3  *
4  * This library is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU Lesser General Public
6  * License as published by the Free Software Foundation; either
7  * version 2.1 of the License, or (at your option) any later version.
8  *
9  * This library is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
12  * Lesser General Public License for more details.
13  *
14  * You should have received a copy of the GNU Lesser General Public
15  * with this program; If not, see <http://www.gnu.org/licenses/>.
16  */
17
18 #include "carl9170.h"
19 #include "printf.h"
20
21 #ifdef CONFIG_CARL9170FW_PRINTF
22 static char *bf;
23 static char buf[12];
24 static unsigned int num;
25 static char uc;
26 static char zs;
27
28 static void out(const char c)
29 {
30         *bf++ = c;
31 }
32
33 static void outDgt(const char dgt)
34 {
35         out(dgt + (dgt < 10 ? '0' : (uc ? 'A' : 'a') - 10));
36         zs = 1;
37 }
38
39 static void divOut(const unsigned int d)
40 {
41         unsigned char dgt = 0;
42
43         while (num >= d) {
44                 num -= d;
45                 dgt++;
46         }
47
48         if (zs || dgt > 0)
49                 outDgt(dgt);
50 }
51
52 void tfp_printf(const char *fmt, ...)
53 {
54         va_list va;
55         char *p;
56         unsigned int i;
57         char ch;
58
59         va_start(va, fmt);
60
61         while ((ch = *(fmt++))) {
62                 if (ch != '%') {
63                         putcharacter(ch);
64                 } else {
65                         char lz = 0;
66                         char w = 0;
67                         ch = *(fmt++);
68
69                         if (ch == '0') {
70                                 ch = *(fmt++);
71                                 lz = 1;
72                         }
73
74                         if (ch >= '0' && ch <= '9') {
75                                 w = 0;
76                                 while (ch >= '0' && ch <= '9') {
77                                         w = (((w << 2) + w) << 1) + ch - '0';
78                                         ch = *fmt++;
79                                         }
80                         }
81
82                         bf = buf;
83                         p = bf;
84                         zs = 0;
85
86                         switch (ch) {
87                         case 0:
88                                 goto abort;
89
90                         case 'u':
91                         case 'd':
92                                 num = va_arg(va, unsigned int);
93                                 if (ch == 'd' && (int) num < 0) {
94                                         num = -(int)num;
95                                         out('-');
96                                 }
97
98                                 for (i = 100000000; i != 1; i /= 10)
99                                         divOut(i);
100
101                                 outDgt(num);
102                                 break;
103
104                         case 'p':
105                         case 'x':
106                         case 'X':
107                                 uc = ch == 'X';
108                                 num = va_arg(va, unsigned int);
109                                 for (i = 0x10000000; i != 0x1; i >>= 4)
110                                         divOut(i);
111
112                                 outDgt(num);
113                                 break;
114
115                         case 'c':
116                                 out((char)(va_arg(va, int)));
117                                 break;
118
119                         case 's':
120                                 p = va_arg(va, char*);
121                                 break;
122                         case '%':
123                                 out('%');
124                                 break;
125
126                         default:
127                                 break;
128                                 }
129
130                         *bf = 0;
131                         bf = p;
132                         while (*bf++ && w > 0)
133                                 w--;
134
135                         while (w-- > 0)
136                                 putcharacter(lz ? '0' : ' ');
137
138                         while ((ch = *p++))
139                                 putcharacter(ch);
140                 }
141         }
142
143 abort:
144         putcharacter('\0');
145         va_end(va);
146 }
147
148 #else
149
150 void min_printf(const char *fmt, ...)
151 {
152         char ch;
153
154         do {
155                 ch = *(fmt++);
156                 putcharacter(ch);
157         } while (ch);
158 }
159
160 #endif /* CONFIG_CARL9170FW_PRINTF */