Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) #include "print_binary.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <linux/log2.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <linux/ctype.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) int binary__fprintf(unsigned char *data, size_t len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) 		    size_t bytes_per_line, binary__fprintf_t printer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 		    void *extra, FILE *fp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 	size_t i, j, mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 	int printed = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	if (!printer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	bytes_per_line = roundup_pow_of_two(bytes_per_line);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	mask = bytes_per_line - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	printed += printer(BINARY_PRINT_DATA_BEGIN, 0, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	for (i = 0; i < len; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 		if ((i & mask) == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 			printed += printer(BINARY_PRINT_LINE_BEGIN, -1, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 			printed += printer(BINARY_PRINT_ADDR, i, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 		printed += printer(BINARY_PRINT_NUM_DATA, data[i], extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 		if (((i & mask) == mask) || i == len - 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 			for (j = 0; j < mask-(i & mask); j++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 				printed += printer(BINARY_PRINT_NUM_PAD, -1, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 			printer(BINARY_PRINT_SEP, i, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 			for (j = i & ~mask; j <= i; j++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 				printed += printer(BINARY_PRINT_CHAR_DATA, data[j], extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 			for (j = 0; j < mask-(i & mask); j++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 				printed += printer(BINARY_PRINT_CHAR_PAD, i, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 			printed += printer(BINARY_PRINT_LINE_END, -1, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	printed += printer(BINARY_PRINT_DATA_END, -1, extra, fp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	return printed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) int is_printable_array(char *p, unsigned int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	if (!p || !len || p[len - 1] != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	len--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	for (i = 0; i < len && p[i]; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 		if (!isprint(p[i]) && !isspace(p[i]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) }