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