WebSVN – HelenOS-historic – Diff – /kernel/trunk/generic/src/debug/print.c


/*
 * Copyright (C) 2001-2004 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
#include <putchar.h>
#include <print.h>
#include <synch/spinlock.h>
#include <arch/arg.h>
#include <arch/asm.h>
 
#include <arch.h>
 
static char digits[] = "0123456789abcdef";  /**< Hexadecimal characters */
SPINLOCK_INITIALIZE(printflock);        /**< printf spinlock */
 
 
/** Print NULL terminated string
 *
 * Print characters from str using putchar() until
 * \\0 character is reached.
 *
 * @param str Characters to print.
 *
 */
static void print_str(const char *str)
{
    int i = 0;
    char c;
    char errstr[] = "(NULL)";
 
    if (str == NULL) {
        while ((c = errstr[i++]))
            putchar(c);
        return;
    }  
   
    while ((c = str[i++]))
        putchar(c);
}
 
 
/** Print hexadecimal digits
 *
 * Print fixed count of hexadecimal digits from
 * the number num. The digits are printed in
 * natural left-to-right order starting with
 * the width-th digit.
 *
 * @param num   Number containing digits.
 * @param width Count of digits to print.
 *
 */
static void print_fixed_hex(const __u64 num, const int width)
{
    int i;
   
    for (i = width*8 - 4; i >= 0; i -= 4)
        putchar(digits[(num>>i) & 0xf]);
}
 
 
/** Print number in given base
 *
 * Print significant digits of a number in given
 * base.
 *
 * @param num  Number to print.
 * @param base Base to print the number in (should
 *             be in range 2 .. 16).
 *
 */
static void print_number(const __native num, const unsigned int base)
{
    int val = num;
    char d[sizeof(__native)*8+1];       /* this is good enough even for base == 2 */
    int i = sizeof(__native)*8-1;
   
    do {
        d[i--] = digits[val % base];
    } while (val /= base);
   
    d[sizeof(__native)*8] = 0; 
    print_str(&d[i + 1]);
}
 
 
 
/** General formatted text print
 *
 * Print text formatted according the fmt parameter
 * and variant arguments. Each formatting directive
 * begins with \% (percentage) character and one of the
 * following character:
 *
 * \%    Prints the percentage character.
 *
 * s    The next variant argument is treated as char*
 *      and printed as a NULL terminated string.
 *
 * c    The next variant argument is treated as a single char.
 *
 * p    The next variant argument is treated as a maximum
 *      bit-width integer with respect to architecture
 *      and printed in full hexadecimal width.
 *
 * P    As with 'p', but '0x' is prefixed.
 *
 * q    The next variant argument is treated as a 64b integer
 *      and printed in full hexadecimal width.
 *
 * Q    As with 'q', but '0x' is prefixed.
 *
 * l    The next variant argument is treated as a 32b integer
 *      and printed in full hexadecimal width.
 *
 * L    As with 'l', but '0x' is prefixed.
 *
 * w    The next variant argument is treated as a 16b integer
 *      and printed in full hexadecimal width.
 *
 * W    As with 'w', but '0x' is prefixed.
 *
 * b    The next variant argument is treated as a 8b integer
 *      and printed in full hexadecimal width.
 *
 * B    As with 'b', but '0x' is prefixed.
 *
 * d    The next variant argument is treated as integer
 *      and printed in standard decimal format (only significant
 *      digits).
 *
 * x    The next variant argument is treated as integer
 *      and printed in standard hexadecimal format (only significant
 *      digits).
 *
 * X    As with 'x', but '0x' is prefixed.
 *
 * All other characters from fmt except the formatting directives
 * are printed in verbatim.
 *
 * @param fmt Formatting NULL terminated string.
 */
void printf(const char *fmt, ...)
{
    int irqpri, i = 0;
    va_list ap;
    char c;
   
    va_start(ap, fmt);
 
    irqpri = interrupts_disable();
    spinlock_lock(&printflock);
 
    while ((c = fmt[i++])) {
        switch (c) {
 
            /* control character */
            case '%':
           
            switch (c = fmt[i++]) {
 
                /* percentile itself */
                case '%':
                break;
 
                /*
                 * String and character conversions.
                 */
                case 's':
                print_str(va_arg(ap, char_ptr));
                goto loop;
 
                case 'c':
                c = (char) va_arg(ap, int);
                break;
 
                /*
                     * Hexadecimal conversions with fixed width.
                     */
                case 'P':
                print_str("0x");
                case 'p':
                    print_fixed_hex(va_arg(ap, __native), sizeof(__native));
                goto loop;
 
                case 'Q':
                print_str("0x");
                case 'q':
                    print_fixed_hex(va_arg(ap, __u64), INT64);
                goto loop;
 
                case 'L':
                print_str("0x");
                case 'l':
                    print_fixed_hex(va_arg(ap, __native), INT32);
                goto loop;
 
                case 'W':
                print_str("0x");
                case 'w':
                    print_fixed_hex(va_arg(ap, __native), INT16);
                goto loop;
 
                case 'B':
                print_str("0x");
                case 'b':
                    print_fixed_hex(va_arg(ap, __native), INT8);
                goto loop;
   
                /*
                     * Decimal and hexadecimal conversions.
                     */
                case 'd':
                    print_number(va_arg(ap, __native), 10);
                goto loop;
 
                case 'X':
                print_str("0x");
                case 'x':
                    print_number(va_arg(ap, __native), 16);
                goto loop;
       
                /*
                 * Bad formatting.
                 */
                default:
                goto out;
            }
 
            default: putchar(c);
        }
   
loop:
        ;
    }
 
out:
    spinlock_unlock(&printflock);
    interrupts_restore(irqpri);
   
    va_end(ap);
}
 

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

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/generic/src/debug/print.c – Rev 675 → 1069