xref: /openbmc/linux/drivers/acpi/acpica/utprint.c (revision 3589b8b8)
1 /******************************************************************************
2  *
3  * Module Name: utprint - Formatted printing routines
4  *
5  *****************************************************************************/
6 
7 /*
8  * Copyright (C) 2000 - 2014, Intel Corp.
9  * All rights reserved.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions, and the following disclaimer,
16  *    without modification.
17  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
18  *    substantially similar to the "NO WARRANTY" disclaimer below
19  *    ("Disclaimer") and any redistribution must be conditioned upon
20  *    including a substantially similar Disclaimer requirement for further
21  *    binary redistribution.
22  * 3. Neither the names of the above-listed copyright holders nor the names
23  *    of any contributors may be used to endorse or promote products derived
24  *    from this software without specific prior written permission.
25  *
26  * Alternatively, this software may be distributed under the terms of the
27  * GNU General Public License ("GPL") version 2 as published by the Free
28  * Software Foundation.
29  *
30  * NO WARRANTY
31  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
32  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
33  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
34  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
35  * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
36  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
37  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
38  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
39  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
40  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
41  * POSSIBILITY OF SUCH DAMAGES.
42  */
43 
44 #include <acpi/acpi.h>
45 #include "accommon.h"
46 
47 #define _COMPONENT          ACPI_UTILITIES
48 ACPI_MODULE_NAME("utprint")
49 
50 #define ACPI_FORMAT_SIGN            0x01
51 #define ACPI_FORMAT_SIGN_PLUS       0x02
52 #define ACPI_FORMAT_SIGN_PLUS_SPACE 0x04
53 #define ACPI_FORMAT_ZERO            0x08
54 #define ACPI_FORMAT_LEFT            0x10
55 #define ACPI_FORMAT_UPPER           0x20
56 #define ACPI_FORMAT_PREFIX          0x40
57 /* Local prototypes */
58 static acpi_size
59 acpi_ut_bound_string_length(const char *string, acpi_size count);
60 
61 static char *acpi_ut_bound_string_output(char *string, const char *end, char c);
62 
63 static char *acpi_ut_format_number(char *string,
64 				   char *end,
65 				   u64 number,
66 				   u8 base, s32 width, s32 precision, u8 type);
67 
68 static char *acpi_ut_put_number(char *string, u64 number, u8 base, u8 upper);
69 
70 /* Module globals */
71 
72 static const char acpi_gbl_lower_hex_digits[] = "0123456789abcdef";
73 static const char acpi_gbl_upper_hex_digits[] = "0123456789ABCDEF";
74 
75 /*******************************************************************************
76  *
77  * FUNCTION:    acpi_ut_bound_string_length
78  *
79  * PARAMETERS:  string              - String with boundary
80  *              count               - Boundary of the string
81  *
82  * RETURN:      Length of the string. Less than or equal to Count.
83  *
84  * DESCRIPTION: Calculate the length of a string with boundary.
85  *
86  ******************************************************************************/
87 
88 static acpi_size
89 acpi_ut_bound_string_length(const char *string, acpi_size count)
90 {
91 	u32 length = 0;
92 
93 	while (*string && count) {
94 		length++;
95 		string++;
96 		count--;
97 	}
98 
99 	return (length);
100 }
101 
102 /*******************************************************************************
103  *
104  * FUNCTION:    acpi_ut_bound_string_output
105  *
106  * PARAMETERS:  string              - String with boundary
107  *              end                 - Boundary of the string
108  *              c                   - Character to be output to the string
109  *
110  * RETURN:      Updated position for next valid character
111  *
112  * DESCRIPTION: Output a character into a string with boundary check.
113  *
114  ******************************************************************************/
115 
116 static char *acpi_ut_bound_string_output(char *string, const char *end, char c)
117 {
118 
119 	if (string < end) {
120 		*string = c;
121 	}
122 
123 	++string;
124 	return (string);
125 }
126 
127 /*******************************************************************************
128  *
129  * FUNCTION:    acpi_ut_put_number
130  *
131  * PARAMETERS:  string              - Buffer to hold reverse-ordered string
132  *              number              - Integer to be converted
133  *              base                - Base of the integer
134  *              upper               - Whether or not using upper cased digits
135  *
136  * RETURN:      Updated position for next valid character
137  *
138  * DESCRIPTION: Convert an integer into a string, note that, the string holds a
139  *              reversed ordered number without the trailing zero.
140  *
141  ******************************************************************************/
142 
143 static char *acpi_ut_put_number(char *string, u64 number, u8 base, u8 upper)
144 {
145 	const char *digits;
146 	u64 digit_index;
147 	char *pos;
148 
149 	pos = string;
150 	digits = upper ? acpi_gbl_upper_hex_digits : acpi_gbl_lower_hex_digits;
151 
152 	if (number == 0) {
153 		*(pos++) = '0';
154 	} else {
155 		while (number) {
156 			(void)acpi_ut_divide(number, base, &number,
157 					     &digit_index);
158 			*(pos++) = digits[digit_index];
159 		}
160 	}
161 
162 	/* *(Pos++) = '0'; */
163 	return (pos);
164 }
165 
166 /*******************************************************************************
167  *
168  * FUNCTION:    acpi_ut_scan_number
169  *
170  * PARAMETERS:  string              - String buffer
171  *              number_ptr          - Where the number is returned
172  *
173  * RETURN:      Updated position for next valid character
174  *
175  * DESCRIPTION: Scan a string for a decimal integer.
176  *
177  ******************************************************************************/
178 
179 const char *acpi_ut_scan_number(const char *string, u64 *number_ptr)
180 {
181 	u64 number = 0;
182 
183 	while (ACPI_IS_DIGIT(*string)) {
184 		number *= 10;
185 		number += *(string++) - '0';
186 	}
187 
188 	*number_ptr = number;
189 	return (string);
190 }
191 
192 /*******************************************************************************
193  *
194  * FUNCTION:    acpi_ut_print_number
195  *
196  * PARAMETERS:  string              - String buffer
197  *              number              - The number to be converted
198  *
199  * RETURN:      Updated position for next valid character
200  *
201  * DESCRIPTION: Print a decimal integer into a string.
202  *
203  ******************************************************************************/
204 
205 const char *acpi_ut_print_number(char *string, u64 number)
206 {
207 	char ascii_string[20];
208 	const char *pos1;
209 	char *pos2;
210 
211 	pos1 = acpi_ut_put_number(ascii_string, number, 10, FALSE);
212 	pos2 = string;
213 
214 	while (pos1 != ascii_string) {
215 		*(pos2++) = *(--pos1);
216 	}
217 
218 	*pos2 = 0;
219 	return (string);
220 }
221 
222 /*******************************************************************************
223  *
224  * FUNCTION:    acpi_ut_format_number
225  *
226  * PARAMETERS:  string              - String buffer with boundary
227  *              end                 - Boundary of the string
228  *              number              - The number to be converted
229  *              base                - Base of the integer
230  *              width               - Field width
231  *              precision           - Precision of the integer
232  *              type                - Special printing flags
233  *
234  * RETURN:      Updated position for next valid character
235  *
236  * DESCRIPTION: Print an integer into a string with any base and any precision.
237  *
238  ******************************************************************************/
239 
240 static char *acpi_ut_format_number(char *string,
241 				   char *end,
242 				   u64 number,
243 				   u8 base, s32 width, s32 precision, u8 type)
244 {
245 	char *pos;
246 	char sign;
247 	char zero;
248 	u8 need_prefix;
249 	u8 upper;
250 	s32 i;
251 	char reversed_string[66];
252 
253 	/* Parameter validation */
254 
255 	if (base < 2 || base > 16) {
256 		return (NULL);
257 	}
258 
259 	if (type & ACPI_FORMAT_LEFT) {
260 		type &= ~ACPI_FORMAT_ZERO;
261 	}
262 
263 	need_prefix = ((type & ACPI_FORMAT_PREFIX)
264 		       && base != 10) ? TRUE : FALSE;
265 	upper = (type & ACPI_FORMAT_UPPER) ? TRUE : FALSE;
266 	zero = (type & ACPI_FORMAT_ZERO) ? '0' : ' ';
267 
268 	/* Calculate size according to sign and prefix */
269 
270 	sign = '\0';
271 	if (type & ACPI_FORMAT_SIGN) {
272 		if ((s64) number < 0) {
273 			sign = '-';
274 			number = -(s64) number;
275 			width--;
276 		} else if (type & ACPI_FORMAT_SIGN_PLUS) {
277 			sign = '+';
278 			width--;
279 		} else if (type & ACPI_FORMAT_SIGN_PLUS_SPACE) {
280 			sign = ' ';
281 			width--;
282 		}
283 	}
284 	if (need_prefix) {
285 		width--;
286 		if (base == 16) {
287 			width--;
288 		}
289 	}
290 
291 	/* Generate full string in reverse order */
292 
293 	pos = acpi_ut_put_number(reversed_string, number, base, upper);
294 	i = ACPI_PTR_DIFF(pos, reversed_string);
295 
296 	/* Printing 100 using %2d gives "100", not "00" */
297 
298 	if (i > precision) {
299 		precision = i;
300 	}
301 
302 	width -= precision;
303 
304 	/* Output the string */
305 
306 	if (!(type & (ACPI_FORMAT_ZERO | ACPI_FORMAT_LEFT))) {
307 		while (--width >= 0) {
308 			string = acpi_ut_bound_string_output(string, end, ' ');
309 		}
310 	}
311 	if (sign) {
312 		string = acpi_ut_bound_string_output(string, end, sign);
313 	}
314 	if (need_prefix) {
315 		string = acpi_ut_bound_string_output(string, end, '0');
316 		if (base == 16) {
317 			string = acpi_ut_bound_string_output(string, end,
318 							     upper ? 'X' : 'x');
319 		}
320 	}
321 	if (!(type & ACPI_FORMAT_LEFT)) {
322 		while (--width >= 0) {
323 			string = acpi_ut_bound_string_output(string, end, zero);
324 		}
325 	}
326 
327 	while (i <= --precision) {
328 		string = acpi_ut_bound_string_output(string, end, '0');
329 	}
330 	while (--i >= 0) {
331 		string = acpi_ut_bound_string_output(string, end,
332 						     reversed_string[i]);
333 	}
334 	while (--width >= 0) {
335 		string = acpi_ut_bound_string_output(string, end, ' ');
336 	}
337 
338 	return (string);
339 }
340 
341 /*******************************************************************************
342  *
343  * FUNCTION:    acpi_ut_vsnprintf
344  *
345  * PARAMETERS:  string              - String with boundary
346  *              size                - Boundary of the string
347  *              format              - Standard printf format
348  *              args                - Argument list
349  *
350  * RETURN:      Number of bytes actually written.
351  *
352  * DESCRIPTION: Formatted output to a string using argument list pointer.
353  *
354  ******************************************************************************/
355 
356 int
357 acpi_ut_vsnprintf(char *string,
358 		  acpi_size size, const char *format, va_list args)
359 {
360 	u8 base = 10;
361 	u8 type = 0;
362 	s32 width = -1;
363 	s32 precision = -1;
364 	char qualifier = 0;
365 	u64 number;
366 	char *pos;
367 	char *end;
368 	char c;
369 	const char *s;
370 	const void *p;
371 	s32 length;
372 	int i;
373 
374 	pos = string;
375 	end = string + size;
376 
377 	for (; *format; ++format) {
378 		if (*format != '%') {
379 			pos = acpi_ut_bound_string_output(pos, end, *format);
380 			continue;
381 		}
382 
383 		/* Process sign */
384 
385 		do {
386 			++format;
387 			if (*format == '#') {
388 				type |= ACPI_FORMAT_PREFIX;
389 			} else if (*format == '0') {
390 				type |= ACPI_FORMAT_ZERO;
391 			} else if (*format == '+') {
392 				type |= ACPI_FORMAT_SIGN_PLUS;
393 			} else if (*format == ' ') {
394 				type |= ACPI_FORMAT_SIGN_PLUS_SPACE;
395 			} else if (*format == '-') {
396 				type |= ACPI_FORMAT_LEFT;
397 			} else {
398 				break;
399 			}
400 		} while (1);
401 
402 		/* Process width */
403 
404 		width = -1;
405 		if (ACPI_IS_DIGIT(*format)) {
406 			format = acpi_ut_scan_number(format, &number);
407 			width = (s32) number;
408 		} else if (*format == '*') {
409 			++format;
410 			width = va_arg(args, int);
411 			if (width < 0) {
412 				width = -width;
413 				type |= ACPI_FORMAT_LEFT;
414 			}
415 		}
416 
417 		/* Process precision */
418 
419 		precision = -1;
420 		if (*format == '.') {
421 			++format;
422 			if (ACPI_IS_DIGIT(*format)) {
423 				format = acpi_ut_scan_number(format, &number);
424 				precision = (s32) number;
425 			} else if (*format == '*') {
426 				++format;
427 				precision = va_arg(args, int);
428 			}
429 			if (precision < 0) {
430 				precision = 0;
431 			}
432 		}
433 
434 		/* Process qualifier */
435 
436 		qualifier = -1;
437 		if (*format == 'h' || *format == 'l' || *format == 'L') {
438 			qualifier = *format;
439 			++format;
440 
441 			if (qualifier == 'l' && *format == 'l') {
442 				qualifier = 'L';
443 				++format;
444 			}
445 		}
446 
447 		switch (*format) {
448 		case '%':
449 
450 			pos = acpi_ut_bound_string_output(pos, end, '%');
451 			continue;
452 
453 		case 'c':
454 
455 			if (!(type & ACPI_FORMAT_LEFT)) {
456 				while (--width > 0) {
457 					pos =
458 					    acpi_ut_bound_string_output(pos,
459 									end,
460 									' ');
461 				}
462 			}
463 
464 			c = (char)va_arg(args, int);
465 			pos = acpi_ut_bound_string_output(pos, end, c);
466 
467 			while (--width > 0) {
468 				pos =
469 				    acpi_ut_bound_string_output(pos, end, ' ');
470 			}
471 			continue;
472 
473 		case 's':
474 
475 			s = va_arg(args, char *);
476 			if (!s) {
477 				s = "<NULL>";
478 			}
479 			length = acpi_ut_bound_string_length(s, precision);
480 			if (!(type & ACPI_FORMAT_LEFT)) {
481 				while (length < width--) {
482 					pos =
483 					    acpi_ut_bound_string_output(pos,
484 									end,
485 									' ');
486 				}
487 			}
488 			for (i = 0; i < length; ++i) {
489 				pos = acpi_ut_bound_string_output(pos, end, *s);
490 				++s;
491 			}
492 			while (length < width--) {
493 				pos =
494 				    acpi_ut_bound_string_output(pos, end, ' ');
495 			}
496 			continue;
497 
498 		case 'o':
499 
500 			base = 8;
501 			break;
502 
503 		case 'X':
504 
505 			type |= ACPI_FORMAT_UPPER;
506 
507 		case 'x':
508 
509 			base = 16;
510 			break;
511 
512 		case 'd':
513 		case 'i':
514 
515 			type |= ACPI_FORMAT_SIGN;
516 
517 		case 'u':
518 
519 			break;
520 
521 		case 'p':
522 
523 			if (width == -1) {
524 				width = 2 * sizeof(void *);
525 				type |= ACPI_FORMAT_ZERO;
526 			}
527 
528 			p = va_arg(args, void *);
529 			pos = acpi_ut_format_number(pos, end,
530 						    ACPI_TO_INTEGER(p), 16,
531 						    width, precision, type);
532 			continue;
533 
534 		default:
535 
536 			pos = acpi_ut_bound_string_output(pos, end, '%');
537 			if (*format) {
538 				pos =
539 				    acpi_ut_bound_string_output(pos, end,
540 								*format);
541 			} else {
542 				--format;
543 			}
544 			continue;
545 		}
546 
547 		if (qualifier == 'L') {
548 			number = va_arg(args, u64);
549 			if (type & ACPI_FORMAT_SIGN) {
550 				number = (s64) number;
551 			}
552 		} else if (qualifier == 'l') {
553 			number = va_arg(args, unsigned long);
554 			if (type & ACPI_FORMAT_SIGN) {
555 				number = (s32) number;
556 			}
557 		} else if (qualifier == 'h') {
558 			number = (u16)va_arg(args, int);
559 			if (type & ACPI_FORMAT_SIGN) {
560 				number = (s16) number;
561 			}
562 		} else {
563 			number = va_arg(args, unsigned int);
564 			if (type & ACPI_FORMAT_SIGN) {
565 				number = (signed int)number;
566 			}
567 		}
568 
569 		pos = acpi_ut_format_number(pos, end, number, base,
570 					    width, precision, type);
571 	}
572 
573 	if (size > 0) {
574 		if (pos < end) {
575 			*pos = '\0';
576 		} else {
577 			end[-1] = '\0';
578 		}
579 	}
580 
581 	return (ACPI_PTR_DIFF(pos, string));
582 }
583 
584 /*******************************************************************************
585  *
586  * FUNCTION:    acpi_ut_snprintf
587  *
588  * PARAMETERS:  string              - String with boundary
589  *              size                - Boundary of the string
590  *              Format, ...         - Standard printf format
591  *
592  * RETURN:      Number of bytes actually written.
593  *
594  * DESCRIPTION: Formatted output to a string.
595  *
596  ******************************************************************************/
597 
598 int acpi_ut_snprintf(char *string, acpi_size size, const char *format, ...)
599 {
600 	va_list args;
601 	int length;
602 
603 	va_start(args, format);
604 	length = acpi_ut_vsnprintf(string, size, format, args);
605 	va_end(args);
606 
607 	return (length);
608 }
609 
610 #ifdef ACPI_APPLICATION
611 /*******************************************************************************
612  *
613  * FUNCTION:    acpi_ut_file_vprintf
614  *
615  * PARAMETERS:  file                - File descriptor
616  *              format              - Standard printf format
617  *              args                - Argument list
618  *
619  * RETURN:      Number of bytes actually written.
620  *
621  * DESCRIPTION: Formatted output to a file using argument list pointer.
622  *
623  ******************************************************************************/
624 
625 int acpi_ut_file_vprintf(ACPI_FILE file, const char *format, va_list args)
626 {
627 	acpi_cpu_flags flags;
628 	int length;
629 
630 	flags = acpi_os_acquire_lock(acpi_gbl_print_lock);
631 	length = acpi_ut_vsnprintf(acpi_gbl_print_buffer,
632 				   sizeof(acpi_gbl_print_buffer), format, args);
633 
634 	(void)acpi_os_write_file(file, acpi_gbl_print_buffer, length, 1);
635 	acpi_os_release_lock(acpi_gbl_print_lock, flags);
636 
637 	return (length);
638 }
639 
640 /*******************************************************************************
641  *
642  * FUNCTION:    acpi_ut_file_printf
643  *
644  * PARAMETERS:  file                - File descriptor
645  *              Format, ...         - Standard printf format
646  *
647  * RETURN:      Number of bytes actually written.
648  *
649  * DESCRIPTION: Formatted output to a file.
650  *
651  ******************************************************************************/
652 
653 int acpi_ut_file_printf(ACPI_FILE file, const char *format, ...)
654 {
655 	va_list args;
656 	int length;
657 
658 	va_start(args, format);
659 	length = acpi_ut_file_vprintf(file, format, args);
660 	va_end(args);
661 
662 	return (length);
663 }
664 #endif
665