source: mainline/boot/generic/printf.c@ 013c4d6

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 013c4d6 was 6b781c0, checked in by Jakub Jermar <jakub@…>, 18 years ago

Merge arm32 into trunk.
  • Property mode set to 100644
File size: 6.0 KB
Line 
1/*
2 * Copyright (c) 2006 Martin Decky
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29/** @addtogroup generic
30 * @{
31 */
32/** @file
33 */
34
35#include "printf.h"
36#include "stdarg.h"
37#include <types.h>
38
39typedef char *char_ptr;
40
41static char digits[] = "0123456789abcdef"; /**< Hexadecimal characters */
42
43void puts(const char *str)
44{
45 int len = 0;
46
47 while (str[len] != 0)
48 len++;
49
50 write(str, len);
51}
52
53
54/** Print hexadecimal digits
55 *
56 * Print fixed count of hexadecimal digits from
57 * the number num. The digits are printed in
58 * natural left-to-right order starting with
59 * the width-th digit.
60 *
61 * @param num Number containing digits.
62 * @param width Count of digits to print.
63 *
64 */
65static void print_fixed_hex(const uint64_t num, const int width)
66{
67 int i;
68
69 for (i = width * 8 - 4; i >= 0; i -= 4)
70 write(digits + ((num >> i) & 0xf), 1);
71}
72
73
74/** Print number in given base
75 *
76 * Print significant digits of a number in given
77 * base.
78 *
79 * @param num Number to print.
80 * @param base Base to print the number in (should
81 * be in range 2 .. 16).
82 *
83 */
84static void print_number(const unative_t num, const unsigned int base)
85{
86 int val = num;
87 char d[sizeof(unative_t) * 8 + 1]; /* this is good enough even for base == 2 */
88 int i = sizeof(unative_t) * 8 - 1;
89
90 do {
91 d[i--] = digits[val % base];
92 } while (val /= base);
93
94 d[sizeof(unative_t) * 8] = 0;
95 puts(&d[i + 1]);
96}
97
98
99/** General formatted text print
100 *
101 * Print text formatted according the fmt parameter
102 * and variant arguments. Each formatting directive
103 * begins with \% (percentage) character and one of the
104 * following character:
105 *
106 * \% Prints the percentage character.
107 *
108 * s The next variant argument is treated as char*
109 * and printed as a NULL terminated string.
110 *
111 * c The next variant argument is treated as a single char.
112 *
113 * p The next variant argument is treated as a maximum
114 * bit-width integer with respect to architecture
115 * and printed in full hexadecimal width.
116 *
117 * P As with 'p', but '0x' is prefixed.
118 *
119 * q The next variant argument is treated as a 64b integer
120 * and printed in full hexadecimal width.
121 *
122 * Q As with 'q', but '0x' is prefixed.
123 *
124 * l The next variant argument is treated as a 32b integer
125 * and printed in full hexadecimal width.
126 *
127 * L As with 'l', but '0x' is prefixed.
128 *
129 * w The next variant argument is treated as a 16b integer
130 * and printed in full hexadecimal width.
131 *
132 * W As with 'w', but '0x' is prefixed.
133 *
134 * b The next variant argument is treated as a 8b integer
135 * and printed in full hexadecimal width.
136 *
137 * B As with 'b', but '0x' is prefixed.
138 *
139 * d The next variant argument is treated as integer
140 * and printed in standard decimal format (only significant
141 * digits).
142 *
143 * x The next variant argument is treated as integer
144 * and printed in standard hexadecimal format (only significant
145 * digits).
146 *
147 * X As with 'x', but '0x' is prefixed.
148 *
149 * All other characters from fmt except the formatting directives
150 * are printed in verbatim.
151 *
152 * @param fmt Formatting NULL terminated string.
153 */
154void printf(const char *fmt, ...)
155{
156 int i = 0;
157 va_list ap;
158 char c;
159
160 va_start(ap, fmt);
161
162 while ((c = fmt[i++])) {
163 switch (c) {
164
165 /* control character */
166 case '%':
167
168 switch (c = fmt[i++]) {
169
170 /* percentile itself */
171 case '%':
172 break;
173
174 /*
175 * String and character conversions.
176 */
177 case 's':
178 puts(va_arg(ap, char_ptr));
179 goto loop;
180
181 case 'c':
182 c = (char) va_arg(ap, int);
183 break;
184
185 /*
186 * Hexadecimal conversions with fixed width.
187 */
188 case 'P':
189 puts("0x");
190 case 'p':
191 print_fixed_hex(va_arg(ap, unative_t), sizeof(unative_t));
192 goto loop;
193
194 case 'Q':
195 puts("0x");
196 case 'q':
197 print_fixed_hex(va_arg(ap, uint64_t), INT64);
198 goto loop;
199
200 case 'L':
201 puts("0x");
202 case 'l':
203 print_fixed_hex(va_arg(ap, unative_t), INT32);
204 goto loop;
205
206 case 'W':
207 puts("0x");
208 case 'w':
209 print_fixed_hex(va_arg(ap, unative_t), INT16);
210 goto loop;
211
212 case 'B':
213 puts("0x");
214 case 'b':
215 print_fixed_hex(va_arg(ap, unative_t), INT8);
216 goto loop;
217
218 /*
219 * Decimal and hexadecimal conversions.
220 */
221 case 'd':
222 print_number(va_arg(ap, unative_t), 10);
223 goto loop;
224
225 case 'X':
226 puts("0x");
227 case 'x':
228 print_number(va_arg(ap, unative_t), 16);
229 goto loop;
230
231 /*
232 * Bad formatting.
233 */
234 default:
235 goto out;
236 }
237
238 default:
239 write(&c, 1);
240 }
241
242loop:
243 ;
244 }
245
246out:
247
248 va_end(ap);
249}
250
251/** @}
252 */
Note: See TracBrowser for help on using the repository browser.