18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci#include "print_binary.h" 38c2ecf20Sopenharmony_ci#include <linux/log2.h> 48c2ecf20Sopenharmony_ci#include <linux/ctype.h> 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ciint binary__fprintf(unsigned char *data, size_t len, 78c2ecf20Sopenharmony_ci size_t bytes_per_line, binary__fprintf_t printer, 88c2ecf20Sopenharmony_ci void *extra, FILE *fp) 98c2ecf20Sopenharmony_ci{ 108c2ecf20Sopenharmony_ci size_t i, j, mask; 118c2ecf20Sopenharmony_ci int printed = 0; 128c2ecf20Sopenharmony_ci 138c2ecf20Sopenharmony_ci if (!printer) 148c2ecf20Sopenharmony_ci return 0; 158c2ecf20Sopenharmony_ci 168c2ecf20Sopenharmony_ci bytes_per_line = roundup_pow_of_two(bytes_per_line); 178c2ecf20Sopenharmony_ci mask = bytes_per_line - 1; 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_DATA_BEGIN, 0, extra, fp); 208c2ecf20Sopenharmony_ci for (i = 0; i < len; i++) { 218c2ecf20Sopenharmony_ci if ((i & mask) == 0) { 228c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_LINE_BEGIN, -1, extra, fp); 238c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_ADDR, i, extra, fp); 248c2ecf20Sopenharmony_ci } 258c2ecf20Sopenharmony_ci 268c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_NUM_DATA, data[i], extra, fp); 278c2ecf20Sopenharmony_ci 288c2ecf20Sopenharmony_ci if (((i & mask) == mask) || i == len - 1) { 298c2ecf20Sopenharmony_ci for (j = 0; j < mask-(i & mask); j++) 308c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_NUM_PAD, -1, extra, fp); 318c2ecf20Sopenharmony_ci 328c2ecf20Sopenharmony_ci printer(BINARY_PRINT_SEP, i, extra, fp); 338c2ecf20Sopenharmony_ci for (j = i & ~mask; j <= i; j++) 348c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_CHAR_DATA, data[j], extra, fp); 358c2ecf20Sopenharmony_ci for (j = 0; j < mask-(i & mask); j++) 368c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_CHAR_PAD, i, extra, fp); 378c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_LINE_END, -1, extra, fp); 388c2ecf20Sopenharmony_ci } 398c2ecf20Sopenharmony_ci } 408c2ecf20Sopenharmony_ci printed += printer(BINARY_PRINT_DATA_END, -1, extra, fp); 418c2ecf20Sopenharmony_ci return printed; 428c2ecf20Sopenharmony_ci} 438c2ecf20Sopenharmony_ci 448c2ecf20Sopenharmony_ciint is_printable_array(char *p, unsigned int len) 458c2ecf20Sopenharmony_ci{ 468c2ecf20Sopenharmony_ci unsigned int i; 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_ci if (!p || !len || p[len - 1] != 0) 498c2ecf20Sopenharmony_ci return 0; 508c2ecf20Sopenharmony_ci 518c2ecf20Sopenharmony_ci len--; 528c2ecf20Sopenharmony_ci 538c2ecf20Sopenharmony_ci for (i = 0; i < len && p[i]; i++) { 548c2ecf20Sopenharmony_ci if (!isprint(p[i]) && !isspace(p[i])) 558c2ecf20Sopenharmony_ci return 0; 568c2ecf20Sopenharmony_ci } 578c2ecf20Sopenharmony_ci return 1; 588c2ecf20Sopenharmony_ci} 59