?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / acpi / acpica / utprint.c
bloba874dac7db5cc9ec46b97b422826d8506c15be62
1 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
2 /******************************************************************************
3 *
4 * Module Name: utprint - Formatted printing routines
5 *
6 * Copyright (C) 2000 - 2020, Intel Corp.
7 *
8 *****************************************************************************/
9
10 #include <acpi/acpi.h>
11 #include "accommon.h"
12
13 #define _COMPONENT ACPI_UTILITIES
14 ACPI_MODULE_NAME("utprint")
15
16 #define ACPI_FORMAT_SIGN 0x01
17 #define ACPI_FORMAT_SIGN_PLUS 0x02
18 #define ACPI_FORMAT_SIGN_PLUS_SPACE 0x04
19 #define ACPI_FORMAT_ZERO 0x08
20 #define ACPI_FORMAT_LEFT 0x10
21 #define ACPI_FORMAT_UPPER 0x20
22 #define ACPI_FORMAT_PREFIX 0x40
23 /* Local prototypes */
24 static acpi_size
25 acpi_ut_bound_string_length(const char *string, acpi_size count);
26
27 static char *acpi_ut_bound_string_output(char *string, const char *end, char c);
28
29 static char *acpi_ut_format_number(char *string,
30 char *end,
31 u64 number,
32 u8 base, s32 width, s32 precision, u8 type);
33
34 static char *acpi_ut_put_number(char *string, u64 number, u8 base, u8 upper);
35
36 /*******************************************************************************
37 *
38 * FUNCTION: acpi_ut_bound_string_length
39 *
40 * PARAMETERS: string - String with boundary
41 * count - Boundary of the string
42 *
43 * RETURN: Length of the string. Less than or equal to Count.
44 *
45 * DESCRIPTION: Calculate the length of a string with boundary.
46 *
47 ******************************************************************************/
48
49 static acpi_size
50 acpi_ut_bound_string_length(const char *string, acpi_size count)
51 {
52 u32 length = 0;
53
54 while (*string && count) {
55 length++;
56 string++;
57 count--;
58 }
59
60 return (length);
61 }
62
63 /*******************************************************************************
64 *
65 * FUNCTION: acpi_ut_bound_string_output
66 *
67 * PARAMETERS: string - String with boundary
68 * end - Boundary of the string
69 * c - Character to be output to the string
70 *
71 * RETURN: Updated position for next valid character
72 *
73 * DESCRIPTION: Output a character into a string with boundary check.
74 *
75 ******************************************************************************/
76
77 static char *acpi_ut_bound_string_output(char *string, const char *end, char c)
78 {
79
80 if (string < end) {
81 *string = c;
82 }
83
84 ++string;
85 return (string);
86 }
87
88 /*******************************************************************************
89 *
90 * FUNCTION: acpi_ut_put_number
91 *
92 * PARAMETERS: string - Buffer to hold reverse-ordered string
93 * number - Integer to be converted
94 * base - Base of the integer
95 * upper - Whether or not using upper cased digits
96 *
97 * RETURN: Updated position for next valid character
98 *
99 * DESCRIPTION: Convert an integer into a string, note that, the string holds a
100 * reversed ordered number without the trailing zero.
101 *
102 ******************************************************************************/
103
104 static char *acpi_ut_put_number(char *string, u64 number, u8 base, u8 upper)
105 {
106 const char *digits;
107 u64 digit_index;
108 char *pos;
109
110 pos = string;
111 digits = upper ? acpi_gbl_upper_hex_digits : acpi_gbl_lower_hex_digits;
112
113 if (number == 0) {
114 *(pos++) = '0';
115 } else {
116 while (number) {
117 (void)acpi_ut_divide(number, base, &number,
118 &digit_index);
119 *(pos++) = digits[digit_index];
120 }
121 }
122
123 /* *(Pos++) = '0'; */
124 return (pos);
125 }
126
127 /*******************************************************************************
128 *
129 * FUNCTION: acpi_ut_scan_number
130 *
131 * PARAMETERS: string - String buffer
132 * number_ptr - Where the number is returned
133 *
134 * RETURN: Updated position for next valid character
135 *
136 * DESCRIPTION: Scan a string for a decimal integer.
137 *
138 ******************************************************************************/
139
140 const char *acpi_ut_scan_number(const char *string, u64 *number_ptr)
141 {
142 u64 number = 0;
143
144 while (isdigit((int)*string)) {
145 acpi_ut_short_multiply(number, 10, &number);
146 number += *(string++) - '0';
147 }
148
149 *number_ptr = number;
150 return (string);
151 }
152
153 /*******************************************************************************
154 *
155 * FUNCTION: acpi_ut_print_number
156 *
157 * PARAMETERS: string - String buffer
158 * number - The number to be converted
159 *
160 * RETURN: Updated position for next valid character
161 *
162 * DESCRIPTION: Print a decimal integer into a string.
163 *
164 ******************************************************************************/
165
166 const char *acpi_ut_print_number(char *string, u64 number)
167 {
168 char ascii_string[20];
169 const char *pos1;
170 char *pos2;
171
172 pos1 = acpi_ut_put_number(ascii_string, number, 10, FALSE);
173 pos2 = string;
174
175 while (pos1 != ascii_string) {
176 *(pos2++) = *(--pos1);
177 }
178
179 *pos2 = 0;
180 return (string);
181 }
182
183 /*******************************************************************************
184 *
185 * FUNCTION: acpi_ut_format_number
186 *
187 * PARAMETERS: string - String buffer with boundary
188 * end - Boundary of the string
189 * number - The number to be converted
190 * base - Base of the integer
191 * width - Field width
192 * precision - Precision of the integer
193 * type - Special printing flags
194 *
195 * RETURN: Updated position for next valid character
196 *
197 * DESCRIPTION: Print an integer into a string with any base and any precision.
198 *
199 ******************************************************************************/
200
201 static char *acpi_ut_format_number(char *string,
202 char *end,
203 u64 number,
204 u8 base, s32 width, s32 precision, u8 type)
205 {
206 char *pos;
207 char sign;
208 char zero;
209 u8 need_prefix;
210 u8 upper;
211 s32 i;
212 char reversed_string[66];
213
214 /* Parameter validation */
215
216 if (base < 2 || base > 16) {
217 return (NULL);
218 }
219
220 if (type & ACPI_FORMAT_LEFT) {
221 type &= ~ACPI_FORMAT_ZERO;
222 }
223
224 need_prefix = ((type & ACPI_FORMAT_PREFIX)
225 && base != 10) ? TRUE : FALSE;
226 upper = (type & ACPI_FORMAT_UPPER) ? TRUE : FALSE;
227 zero = (type & ACPI_FORMAT_ZERO) ? '0' : ' ';
228
229 /* Calculate size according to sign and prefix */
230
231 sign = '\0';
232 if (type & ACPI_FORMAT_SIGN) {
233 if ((s64)number < 0) {
234 sign = '-';
235 number = -(s64)number;
236 width--;
237 } else if (type & ACPI_FORMAT_SIGN_PLUS) {
238 sign = '+';
239 width--;
240 } else if (type & ACPI_FORMAT_SIGN_PLUS_SPACE) {
241 sign = ' ';
242 width--;
243 }
244 }
245 if (need_prefix) {
246 width--;
247 if (base == 16) {
248 width--;
249 }
250 }
251
252 /* Generate full string in reverse order */
253
254 pos = acpi_ut_put_number(reversed_string, number, base, upper);
255 i = (s32)ACPI_PTR_DIFF(pos, reversed_string);
256
257 /* Printing 100 using %2d gives "100", not "00" */
258
259 if (i > precision) {
260 precision = i;
261 }
262
263 width -= precision;
264
265 /* Output the string */
266
267 if (!(type & (ACPI_FORMAT_ZERO | ACPI_FORMAT_LEFT))) {
268 while (--width >= 0) {
269 string = acpi_ut_bound_string_output(string, end, ' ');
270 }
271 }
272 if (sign) {
273 string = acpi_ut_bound_string_output(string, end, sign);
274 }
275 if (need_prefix) {
276 string = acpi_ut_bound_string_output(string, end, '0');
277 if (base == 16) {
278 string =
279 acpi_ut_bound_string_output(string, end,
280 upper ? 'X' : 'x');
281 }
282 }
283 if (!(type & ACPI_FORMAT_LEFT)) {
284 while (--width >= 0) {
285 string = acpi_ut_bound_string_output(string, end, zero);
286 }
287 }
288
289 while (i <= --precision) {
290 string = acpi_ut_bound_string_output(string, end, '0');
291 }
292 while (--i >= 0) {
293 string = acpi_ut_bound_string_output(string, end,
294 reversed_string[i]);
295 }
296 while (--width >= 0) {
297 string = acpi_ut_bound_string_output(string, end, ' ');
298 }
299
300 return (string);
301 }
302
303 /*******************************************************************************
304 *
305 * FUNCTION: vsnprintf
306 *
307 * PARAMETERS: string - String with boundary
308 * size - Boundary of the string
309 * format - Standard printf format
310 * args - Argument list
311 *
312 * RETURN: Number of bytes actually written.
313 *
314 * DESCRIPTION: Formatted output to a string using argument list pointer.
315 *
316 ******************************************************************************/
317
318 int vsnprintf(char *string, acpi_size size, const char *format, va_list args)
319 {
320 u8 base;
321 u8 type;
322 s32 width;
323 s32 precision;
324 char qualifier;
325 u64 number;
326 char *pos;
327 char *end;
328 char c;
329 const char *s;
330 const void *p;
331 s32 length;
332 int i;
333
334 pos = string;
335 end = string + size;
336
337 for (; *format; ++format) {
338 if (*format != '%') {
339 pos = acpi_ut_bound_string_output(pos, end, *format);
340 continue;
341 }
342
343 type = 0;
344 base = 10;
345
346 /* Process sign */
347
348 do {
349 ++format;
350 if (*format == '#') {
351 type |= ACPI_FORMAT_PREFIX;
352 } else if (*format == '0') {
353 type |= ACPI_FORMAT_ZERO;
354 } else if (*format == '+') {
355 type |= ACPI_FORMAT_SIGN_PLUS;
356 } else if (*format == ' ') {
357 type |= ACPI_FORMAT_SIGN_PLUS_SPACE;
358 } else if (*format == '-') {
359 type |= ACPI_FORMAT_LEFT;
360 } else {
361 break;
362 }
363
364 } while (1);
365
366 /* Process width */
367
368 width = -1;
369 if (isdigit((int)*format)) {
370 format = acpi_ut_scan_number(format, &number);
371 width = (s32)number;
372 } else if (*format == '*') {
373 ++format;
374 width = va_arg(args, int);
375 if (width < 0) {
376 width = -width;
377 type |= ACPI_FORMAT_LEFT;
378 }
379 }
380
381 /* Process precision */
382
383 precision = -1;
384 if (*format == '.') {
385 ++format;
386 if (isdigit((int)*format)) {
387 format = acpi_ut_scan_number(format, &number);
388 precision = (s32)number;
389 } else if (*format == '*') {
390 ++format;
391 precision = va_arg(args, int);
392 }
393
394 if (precision < 0) {
395 precision = 0;
396 }
397 }
398
399 /* Process qualifier */
400
401 qualifier = -1;
402 if (*format == 'h' || *format == 'l' || *format == 'L') {
403 qualifier = *format;
404 ++format;
405
406 if (qualifier == 'l' && *format == 'l') {
407 qualifier = 'L';
408 ++format;
409 }
410 }
411
412 switch (*format) {
413 case '%':
414
415 pos = acpi_ut_bound_string_output(pos, end, '%');
416 continue;
417
418 case 'c':
419
420 if (!(type & ACPI_FORMAT_LEFT)) {
421 while (--width > 0) {
422 pos =
423 acpi_ut_bound_string_output(pos,
424 end,
425 ' ');
426 }
427 }
428
429 c = (char)va_arg(args, int);
430 pos = acpi_ut_bound_string_output(pos, end, c);
431
432 while (--width > 0) {
433 pos =
434 acpi_ut_bound_string_output(pos, end, ' ');
435 }
436 continue;
437
438 case 's':
439
440 s = va_arg(args, char *);
441 if (!s) {
442 s = "<NULL>";
443 }
444 length = (s32)acpi_ut_bound_string_length(s, precision);
445 if (!(type & ACPI_FORMAT_LEFT)) {
446 while (length < width--) {
447 pos =
448 acpi_ut_bound_string_output(pos,
449 end,
450 ' ');
451 }
452 }
453
454 for (i = 0; i < length; ++i) {
455 pos = acpi_ut_bound_string_output(pos, end, *s);
456 ++s;
457 }
458
459 while (length < width--) {
460 pos =
461 acpi_ut_bound_string_output(pos, end, ' ');
462 }
463 continue;
464
465 case 'o':
466
467 base = 8;
468 break;
469
470 case 'X':
471
472 type |= ACPI_FORMAT_UPPER;
473 /* FALLTHROUGH */
474
475 case 'x':
476
477 base = 16;
478 break;
479
480 case 'd':
481 case 'i':
482
483 type |= ACPI_FORMAT_SIGN;
484
485 case 'u':
486
487 break;
488
489 case 'p':
490
491 if (width == -1) {
492 width = 2 * sizeof(void *);
493 type |= ACPI_FORMAT_ZERO;
494 }
495
496 p = va_arg(args, void *);
497 pos =
498 acpi_ut_format_number(pos, end, ACPI_TO_INTEGER(p),
499 16, width, precision, type);
500 continue;
501
502 default:
503
504 pos = acpi_ut_bound_string_output(pos, end, '%');
505 if (*format) {
506 pos =
507 acpi_ut_bound_string_output(pos, end,
508 *format);
509 } else {
510 --format;
511 }
512 continue;
513 }
514
515 if (qualifier == 'L') {
516 number = va_arg(args, u64);
517 if (type & ACPI_FORMAT_SIGN) {
518 number = (s64)number;
519 }
520 } else if (qualifier == 'l') {
521 number = va_arg(args, unsigned long);
522 if (type & ACPI_FORMAT_SIGN) {
523 number = (s32)number;
524 }
525 } else if (qualifier == 'h') {
526 number = (u16)va_arg(args, int);
527 if (type & ACPI_FORMAT_SIGN) {
528 number = (s16)number;
529 }
530 } else {
531 number = va_arg(args, unsigned int);
532 if (type & ACPI_FORMAT_SIGN) {
533 number = (signed int)number;
534 }
535 }
536
537 pos = acpi_ut_format_number(pos, end, number, base,
538 width, precision, type);
539 }
540
541 if (size > 0) {
542 if (pos < end) {
543 *pos = '\0';
544 } else {
545 end[-1] = '\0';
546 }
547 }
548
549 return ((int)ACPI_PTR_DIFF(pos, string));
550 }
551
552 /*******************************************************************************
553 *
554 * FUNCTION: snprintf
555 *
556 * PARAMETERS: string - String with boundary
557 * size - Boundary of the string
558 * Format, ... - Standard printf format
559 *
560 * RETURN: Number of bytes actually written.
561 *
562 * DESCRIPTION: Formatted output to a string.
563 *
564 ******************************************************************************/
565
566 int snprintf(char *string, acpi_size size, const char *format, ...)
567 {
568 va_list args;
569 int length;
570
571 va_start(args, format);
572 length = vsnprintf(string, size, format, args);
573 va_end(args);
574
575 return (length);
576 }
577
578 /*******************************************************************************
579 *
580 * FUNCTION: sprintf
581 *
582 * PARAMETERS: string - String with boundary
583 * Format, ... - Standard printf format
584 *
585 * RETURN: Number of bytes actually written.
586 *
587 * DESCRIPTION: Formatted output to a string.
588 *
589 ******************************************************************************/
590
591 int sprintf(char *string, const char *format, ...)
592 {
593 va_list args;
594 int length;
595
596 va_start(args, format);
597 length = vsnprintf(string, ACPI_UINT32_MAX, format, args);
598 va_end(args);
599
600 return (length);
601 }
602
603 #ifdef ACPI_APPLICATION
604 /*******************************************************************************
605 *
606 * FUNCTION: vprintf
607 *
608 * PARAMETERS: format - Standard printf format
609 * args - Argument list
610 *
611 * RETURN: Number of bytes actually written.
612 *
613 * DESCRIPTION: Formatted output to stdout using argument list pointer.
614 *
615 ******************************************************************************/
616
617 int vprintf(const char *format, va_list args)
618 {
619 acpi_cpu_flags flags;
620 int length;
621
622 flags = acpi_os_acquire_lock(acpi_gbl_print_lock);
623 length = vsnprintf(acpi_gbl_print_buffer,
624 sizeof(acpi_gbl_print_buffer), format, args);
625
626 (void)fwrite(acpi_gbl_print_buffer, length, 1, ACPI_FILE_OUT);
627 acpi_os_release_lock(acpi_gbl_print_lock, flags);
628
629 return (length);
630 }
631
632 /*******************************************************************************
633 *
634 * FUNCTION: printf
635 *
636 * PARAMETERS: Format, ... - Standard printf format
637 *
638 * RETURN: Number of bytes actually written.
639 *
640 * DESCRIPTION: Formatted output to stdout.
641 *
642 ******************************************************************************/
643
644 int printf(const char *format, ...)
645 {
646 va_list args;
647 int length;
648
649 va_start(args, format);
650 length = vprintf(format, args);
651 va_end(args);
652
653 return (length);
654 }
655
656 /*******************************************************************************
657 *
658 * FUNCTION: vfprintf
659 *
660 * PARAMETERS: file - File descriptor
661 * format - Standard printf format
662 * args - Argument list
663 *
664 * RETURN: Number of bytes actually written.
665 *
666 * DESCRIPTION: Formatted output to a file using argument list pointer.
667 *
668 ******************************************************************************/
669
670 int vfprintf(FILE * file, const char *format, va_list args)
671 {
672 acpi_cpu_flags flags;
673 int length;
674
675 flags = acpi_os_acquire_lock(acpi_gbl_print_lock);
676 length = vsnprintf(acpi_gbl_print_buffer,
677 sizeof(acpi_gbl_print_buffer), format, args);
678
679 (void)fwrite(acpi_gbl_print_buffer, length, 1, file);
680 acpi_os_release_lock(acpi_gbl_print_lock, flags);
681
682 return (length);
683 }
684
685 /*******************************************************************************
686 *
687 * FUNCTION: fprintf
688 *
689 * PARAMETERS: file - File descriptor
690 * Format, ... - Standard printf format
691 *
692 * RETURN: Number of bytes actually written.
693 *
694 * DESCRIPTION: Formatted output to a file.
695 *
696 ******************************************************************************/
697
698 int fprintf(FILE * file, const char *format, ...)
699 {
700 va_list args;
701 int length;
702
703 va_start(args, format);
704 length = vfprintf(file, format, args);
705 va_end(args);
706
707 return (length);
708 }
709 #endif
Linux with added FPC-III support