WebSVN – HelenOS – Blame – /trunk/boot/generic/printf.c

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

Subversion Repositories HelenOS

(root)/trunk/boot/generic/printf.c @ 4308 – Rev 1018