Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Copyright 2011 The Chromium Authors, All Rights Reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Copyright 2008 Jon Loeliger, Freescale Semiconductor, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  * util_is_printable_string contributed by
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *	Pantelis Antoniou <pantelis.antoniou AT gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <ctype.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <stdio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <stdlib.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <stdarg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <assert.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <inttypes.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <fcntl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <unistd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include "libfdt.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include "util.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include "version_gen.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) char *xstrdup(const char *s)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	int len = strlen(s) + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	char *d = xmalloc(len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	memcpy(d, s, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) int xavsprintf_append(char **strp, const char *fmt, va_list ap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	int n, size = 0;	/* start with 128 bytes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	char *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	va_list ap_copy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 	p = *strp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	if (p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 		size = strlen(p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	va_copy(ap_copy, ap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	n = vsnprintf(NULL, 0, fmt, ap_copy) + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	va_end(ap_copy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	p = xrealloc(p, size + n);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	n = vsnprintf(p + size, n, fmt, ap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	*strp = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	return strlen(p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) int xasprintf_append(char **strp, const char *fmt, ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	int n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	va_list ap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	va_start(ap, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	n = xavsprintf_append(strp, fmt, ap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	va_end(ap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	return n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) int xasprintf(char **strp, const char *fmt, ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	int n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	va_list ap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	*strp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	va_start(ap, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	n = xavsprintf_append(strp, fmt, ap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	va_end(ap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	return n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) char *join_path(const char *path, const char *name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	int lenp = strlen(path);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	int lenn = strlen(name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	int needslash = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 	char *str;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 	len = lenp + lenn + 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	if ((lenp > 0) && (path[lenp-1] == '/')) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 		needslash = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 		len--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	str = xmalloc(len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	memcpy(str, path, lenp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	if (needslash) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 		str[lenp] = '/';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		lenp++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	memcpy(str+lenp, name, lenn+1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	return str;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) bool util_is_printable_string(const void *data, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	const char *s = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	const char *ss, *se;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	/* zero length is not */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	if (len == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	/* must terminate with zero */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	if (s[len - 1] != '\0')
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	se = s + len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	while (s < se) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		ss = s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 		while (s < se && *s && isprint((unsigned char)*s))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 			s++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		/* not zero, or not done yet */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 		if (*s != '\0' || s == ss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 		s++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)  * Parse a octal encoded character starting at index i in string s.  The
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)  * resulting character will be returned and the index i will be updated to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)  * point at the character directly after the end of the encoding, this may be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)  * the '\0' terminator of the string.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) static char get_oct_char(const char *s, int *i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	char x[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	char *endx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	long val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	x[3] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	strncpy(x, s + *i, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	val = strtol(x, &endx, 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	assert(endx > x);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	(*i) += endx - x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)  * Parse a hexadecimal encoded character starting at index i in string s.  The
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)  * resulting character will be returned and the index i will be updated to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)  * point at the character directly after the end of the encoding, this may be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)  * the '\0' terminator of the string.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) static char get_hex_char(const char *s, int *i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	char x[3];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	char *endx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	long val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	x[2] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	strncpy(x, s + *i, 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	val = strtol(x, &endx, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	if (!(endx  > x))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 		die("\\x used with no following hex digits\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	(*i) += endx - x;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) char get_escape_char(const char *s, int *i)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	char	c = s[*i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	int	j = *i + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	char	val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	switch (c) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	case 'a':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		val = '\a';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	case 'b':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 		val = '\b';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	case 't':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 		val = '\t';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	case 'n':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 		val = '\n';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	case 'v':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		val = '\v';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	case 'f':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 		val = '\f';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	case 'r':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 		val = '\r';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 	case '0':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	case '1':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	case '2':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	case '3':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 	case '4':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	case '5':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	case '6':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	case '7':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 		j--; /* need to re-read the first digit as
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 		      * part of the octal value */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 		val = get_oct_char(s, &j);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 	case 'x':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		val = get_hex_char(s, &j);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		val = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	(*i) = j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) int utilfdt_read_err(const char *filename, char **buffp, size_t *len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	int fd = 0;	/* assume stdin */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	char *buf = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 	size_t bufsize = 1024, offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	*buffp = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 	if (strcmp(filename, "-") != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 		fd = open(filename, O_RDONLY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 		if (fd < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 			return errno;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	/* Loop until we have read everything */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	buf = xmalloc(bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 		/* Expand the buffer to hold the next chunk */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 		if (offset == bufsize) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 			bufsize *= 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 			buf = xrealloc(buf, bufsize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 		ret = read(fd, &buf[offset], bufsize - offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 		if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 			ret = errno;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		offset += ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	} while (ret != 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	/* Clean up, including closing stdin; return errno on error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	close(fd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		free(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 		*buffp = buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	if (len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 		*len = bufsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) char *utilfdt_read(const char *filename, size_t *len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	char *buff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	int ret = utilfdt_read_err(filename, &buff, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 		fprintf(stderr, "Couldn't open blob from '%s': %s\n", filename,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 			strerror(ret));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 	/* Successful read */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	return buff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) int utilfdt_write_err(const char *filename, const void *blob)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 	int fd = 1;	/* assume stdout */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 	int totalsize;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	int offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	const char *ptr = blob;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	if (strcmp(filename, "-") != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		fd = open(filename, O_WRONLY | O_CREAT | O_TRUNC, 0666);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 		if (fd < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 			return errno;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 	totalsize = fdt_totalsize(blob);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	while (offset < totalsize) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 		ret = write(fd, ptr + offset, totalsize - offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 		if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 			ret = -errno;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 		offset += ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	/* Close the file/stdin; return errno on error */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	if (fd != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 		close(fd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	return ret < 0 ? -ret : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) int utilfdt_write(const char *filename, const void *blob)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	int ret = utilfdt_write_err(filename, blob);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 		fprintf(stderr, "Couldn't write blob to '%s': %s\n", filename,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 			strerror(ret));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	return ret ? -1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) int utilfdt_decode_type(const char *fmt, int *type, int *size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	int qualifier = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 	if (!*fmt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	/* get the conversion qualifier */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	*size = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	if (strchr("hlLb", *fmt)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 		qualifier = *fmt++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 		if (qualifier == *fmt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 			switch (*fmt++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) /* TODO:		case 'l': qualifier = 'L'; break;*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 			case 'h':
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 				qualifier = 'b';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 				break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	/* we should now have a type */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	if ((*fmt == '\0') || !strchr("iuxs", *fmt))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 	/* convert qualifier (bhL) to byte size */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	if (*fmt != 's')
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 		*size = qualifier == 'b' ? 1 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 				qualifier == 'h' ? 2 :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 				qualifier == 'l' ? 4 : -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 	*type = *fmt++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 	/* that should be it! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 	if (*fmt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 		return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) void utilfdt_print_data(const char *data, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 	const char *s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 	/* no data, don't print */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 	if (len == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 	if (util_is_printable_string(data, len)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 		printf(" = ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 		s = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 		do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 			printf("\"%s\"", s);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 			s += strlen(s) + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 			if (s < data + len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 				printf(", ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 		} while (s < data + len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 	} else if ((len % 4) == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 		const fdt32_t *cell = (const fdt32_t *)data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 		printf(" = <");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 		for (i = 0, len /= 4; i < len; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 			printf("0x%08" PRIx32 "%s", fdt32_to_cpu(cell[i]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 			       i < (len - 1) ? " " : "");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 		printf(">");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 		const unsigned char *p = (const unsigned char *)data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 		printf(" = [");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 		for (i = 0; i < len; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 			printf("%02x%s", *p++, i < len - 1 ? " " : "");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 		printf("]");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) void NORETURN util_version(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 	printf("Version: %s\n", DTC_VERSION);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 	exit(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) void NORETURN util_usage(const char *errmsg, const char *synopsis,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 			 const char *short_opts,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 			 struct option const long_opts[],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 			 const char * const opts_help[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 	FILE *fp = errmsg ? stderr : stdout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 	const char a_arg[] = "<arg>";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 	size_t a_arg_len = strlen(a_arg) + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 	size_t i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 	int optlen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 	fprintf(fp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 		"Usage: %s\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 		"\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 		"Options: -[%s]\n", synopsis, short_opts);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 	/* prescan the --long opt length to auto-align */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 	optlen = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 	for (i = 0; long_opts[i].name; ++i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 		/* +1 is for space between --opt and help text */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 		int l = strlen(long_opts[i].name) + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 		if (long_opts[i].has_arg == a_argument)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 			l += a_arg_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 		if (optlen < l)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 			optlen = l;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 	for (i = 0; long_opts[i].name; ++i) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 		/* helps when adding new applets or options */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 		assert(opts_help[i] != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 		/* first output the short flag if it has one */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 		if (long_opts[i].val > '~')
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 			fprintf(fp, "      ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 			fprintf(fp, "  -%c, ", long_opts[i].val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 		/* then the long flag */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) 		if (long_opts[i].has_arg == no_argument)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 			fprintf(fp, "--%-*s", optlen, long_opts[i].name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 			fprintf(fp, "--%s %s%*s", long_opts[i].name, a_arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 				(int)(optlen - strlen(long_opts[i].name) - a_arg_len), "");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 		/* finally the help text */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) 		fprintf(fp, "%s\n", opts_help[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) 	if (errmsg) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 		fprintf(fp, "\nError: %s\n", errmsg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) 		exit(EXIT_FAILURE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) 	} else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 		exit(EXIT_SUCCESS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) }