WebSVN – HelenOS – Blame – /SPARTAN/trunk/generic/src/debug/print.c

Rev	Author	Line No.	Line
1	jermar	1	/*
		2	* Copyright (C) 2001-2004 Jakub Jermar
		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	#include <putchar.h>
		30	#include <print.h>
		31	#include <synch/spinlock.h>
40	jermar	32	#include <arch/arg.h>
1	jermar	33
40	jermar	34
61	decky	35	static char digits[] = "0123456789abcdef"; /*< Hexadecimal characters /
		36	static spinlock_t printflock; /*< printf spinlock /
1	jermar	37
61	decky	38
		39	/** Print NULL terminated string
		40	*
		41	* Print characters from str using putchar() until
		42	* \x00 character is reached.
		43	*
		44	* @param str Characters to print.
		45	*
		46	*/
1	jermar	47	void print_str(char *str)
		48	{
		49	int i = 0;
		50	char c;
		51
		52	while (c = str[i++])
		53	putchar(c);
		54	}
		55
		56
61	decky	57	/** Print hexadecimal digits
		58	*
		59	* Print fixed count of hexadecimal digits from
		60	* the number num. The digits are printed in
		61	* natural left-to-right order starting with
		62	* the width-th digit.
		63	*
		64	* @param num Number containing digits.
		65	* @param width Count of digits to print.
		66	*
1	jermar	67	*/
42	jermar	68	void print_fixed_hex(__native num, int width)
1	jermar	69	{
		70	int i;
		71
		72	for (i = width*8 - 4; i >= 0; i -= 4)
		73	putchar(digits[(num>>i) & 0xf]);
		74	}
		75
61	decky	76
		77	/** Print number in given base
		78	*
		79	* Print significant digits of a number in given
		80	* base.
		81	*
		82	* @param num Number to print.
		83	* @param base Base to print the number in (should
		84	* be in range 2 .. 16).
		85	*
1	jermar	86	*/
42	jermar	87	void print_number(__native num, int base)
1	jermar	88	{
42	jermar	89	char d[sizeof(__native)8+1]; / this is good enough even for base == 2 */
		90	int i = sizeof(__native)*8-1;
1	jermar	91
		92	do {
		93	d[i--] = digits[num % base];
		94	} while (num /= base);
		95
42	jermar	96	d[sizeof(__native)*8] = 0;
1	jermar	97	print_str(&d[i + 1]);
		98	}
		99
61	decky	100
		101	/** General formatted text print
		102	*
		103	* Print text formatted according the fmt parameter
		104	* and variant arguments. Each formatting directive
		105	* begins with % (percentage) character and one of the
		106	* following character:
		107	*
		108	* % Prints the percentage character.
		109	* s The next variant argument is threated as char*
		110	* and printed as a NULL terminated string.
		111	* c The next variant argument is threated as a single char.
		112	* l The next variant argument is threated as a 32b integer
		113	* and printed in full hexadecimal width.
		114	* L As with 'l', but '0x' is prefixed.
		115	* w The next variant argument is threated as a 16b integer
		116	* and printed in full hexadecimal width.
		117	* W As with 'w', but '0x' is prefixed.
		118	* b The next variant argument is threated as a 8b integer
		119	* and printed in full hexadecimal width.
		120	* N As with 'b', but '0x' is prefixed.
		121	* d The next variant argument is threated as integer
		122	* and printed in standard decimal format (only significant
		123	* digits).
		124	* x The next variant argument is threated as integer
		125	* and printed in standard hexadecimal format (only significant
		126	* digits).
		127	* X As with 'x', but '0x' is prefixed.
		128	*
		129	* All other characters from fmt except the formatting directives
		130	* are printed in verbatim.
		131	*
		132	* @param fmt Formatting NULL terminated string.
		133	*
1	jermar	134	*/
		135	void printf(char *fmt, ...)
		136	{
40	jermar	137	int irqpri, i = 0;
		138	va_list ap;
		139	char c;
1	jermar	140
40	jermar	141	va_start(ap, fmt);
		142
1	jermar	143	irqpri = cpu_priority_high();
		144	spinlock_lock(&printflock);
40	jermar	145
1	jermar	146	while (c = fmt[i++]) {
		147	switch (c) {
		148
		149	/* control character */
		150	case '%':
		151	switch (c = fmt[i++]) {
		152
		153	/* percentile itself */
		154	case '%':
		155	break;
		156
		157	/*
		158	* String and character conversions.
		159	*/
		160	case 's':
40	jermar	161	print_str(va_arg(ap, char_ptr));
1	jermar	162	goto loop;
		163
		164	case 'c':
42	jermar	165	c = (char) va_arg(ap, int);
1	jermar	166	break;
		167
		168	/*
		169	* Hexadecimal conversions with fixed width.
		170	*/
		171	case 'L':
		172	print_str("0x");
		173	case 'l':
40	jermar	174	print_fixed_hex(va_arg(ap, __native), INT32);
1	jermar	175	goto loop;
		176
		177	case 'W':
		178	print_str("0x");
		179	case 'w':
40	jermar	180	print_fixed_hex(va_arg(ap, __native), INT16);
1	jermar	181	goto loop;
		182
		183	case 'B':
		184	print_str("0x");
		185	case 'b':
40	jermar	186	print_fixed_hex(va_arg(ap, __native), INT8);
1	jermar	187	goto loop;
		188
		189	/*
		190	* Decimal and hexadecimal conversions.
		191	*/
		192	case 'd':
40	jermar	193	print_number(va_arg(ap, __native), 10);
1	jermar	194	goto loop;
		195
		196	case 'X':
		197	print_str("0x");
		198	case 'x':
40	jermar	199	print_number(va_arg(ap, __native), 16);
1	jermar	200	goto loop;
		201
		202	/*
		203	* Bad formatting.
		204	*/
		205	default:
		206	goto out;
		207	}
		208
		209	default: putchar(c);
		210	}
		211
		212	loop:
		213	;
		214	}
		215
		216	out:
		217	spinlock_unlock(&printflock);
		218	cpu_priority_restore(irqpri);
40	jermar	219
		220	va_end(ap);
1	jermar	221	}

Subversion Repositories HelenOS

(root)/SPARTAN/trunk/generic/src/debug/print.c @ 452 – Rev 61