11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
29fffb55fSDavid Gibson /*
39fffb55fSDavid Gibson * (C) Copyright David Gibson <dwg@au1.ibm.com>, IBM Corporation. 2005.
49fffb55fSDavid Gibson */
59fffb55fSDavid Gibson
69fffb55fSDavid Gibson #include "dtc.h"
79fffb55fSDavid Gibson
data_free(struct data d)89fffb55fSDavid Gibson void data_free(struct data d)
99fffb55fSDavid Gibson {
109fffb55fSDavid Gibson struct marker *m, *nm;
119fffb55fSDavid Gibson
129fffb55fSDavid Gibson m = d.markers;
139fffb55fSDavid Gibson while (m) {
149fffb55fSDavid Gibson nm = m->next;
159fffb55fSDavid Gibson free(m->ref);
169fffb55fSDavid Gibson free(m);
179fffb55fSDavid Gibson m = nm;
189fffb55fSDavid Gibson }
199fffb55fSDavid Gibson
209fffb55fSDavid Gibson if (d.val)
219fffb55fSDavid Gibson free(d.val);
229fffb55fSDavid Gibson }
239fffb55fSDavid Gibson
data_grow_for(struct data d,unsigned int xlen)24*79edff12SRob Herring struct data data_grow_for(struct data d, unsigned int xlen)
259fffb55fSDavid Gibson {
269fffb55fSDavid Gibson struct data nd;
27*79edff12SRob Herring unsigned int newsize;
289fffb55fSDavid Gibson
299fffb55fSDavid Gibson if (xlen == 0)
309fffb55fSDavid Gibson return d;
319fffb55fSDavid Gibson
329fffb55fSDavid Gibson nd = d;
339fffb55fSDavid Gibson
349fffb55fSDavid Gibson newsize = xlen;
359fffb55fSDavid Gibson
369fffb55fSDavid Gibson while ((d.len + xlen) > newsize)
379fffb55fSDavid Gibson newsize *= 2;
389fffb55fSDavid Gibson
399fffb55fSDavid Gibson nd.val = xrealloc(d.val, newsize);
409fffb55fSDavid Gibson
419fffb55fSDavid Gibson return nd;
429fffb55fSDavid Gibson }
439fffb55fSDavid Gibson
data_copy_mem(const char * mem,int len)449fffb55fSDavid Gibson struct data data_copy_mem(const char *mem, int len)
459fffb55fSDavid Gibson {
469fffb55fSDavid Gibson struct data d;
479fffb55fSDavid Gibson
489fffb55fSDavid Gibson d = data_grow_for(empty_data, len);
499fffb55fSDavid Gibson
509fffb55fSDavid Gibson d.len = len;
519fffb55fSDavid Gibson memcpy(d.val, mem, len);
529fffb55fSDavid Gibson
539fffb55fSDavid Gibson return d;
549fffb55fSDavid Gibson }
559fffb55fSDavid Gibson
data_copy_escape_string(const char * s,int len)569fffb55fSDavid Gibson struct data data_copy_escape_string(const char *s, int len)
579fffb55fSDavid Gibson {
589fffb55fSDavid Gibson int i = 0;
599fffb55fSDavid Gibson struct data d;
609fffb55fSDavid Gibson char *q;
619fffb55fSDavid Gibson
62f858927fSRob Herring d = data_add_marker(empty_data, TYPE_STRING, NULL);
63f858927fSRob Herring d = data_grow_for(d, len + 1);
649fffb55fSDavid Gibson
659fffb55fSDavid Gibson q = d.val;
669fffb55fSDavid Gibson while (i < len) {
679fffb55fSDavid Gibson char c = s[i++];
689fffb55fSDavid Gibson
69cd296721SStephen Warren if (c == '\\')
70cd296721SStephen Warren c = get_escape_char(s, &i);
719fffb55fSDavid Gibson
729fffb55fSDavid Gibson q[d.len++] = c;
739fffb55fSDavid Gibson }
749fffb55fSDavid Gibson
759fffb55fSDavid Gibson q[d.len++] = '\0';
769fffb55fSDavid Gibson return d;
779fffb55fSDavid Gibson }
789fffb55fSDavid Gibson
data_copy_file(FILE * f,size_t maxlen)799fffb55fSDavid Gibson struct data data_copy_file(FILE *f, size_t maxlen)
809fffb55fSDavid Gibson {
819fffb55fSDavid Gibson struct data d = empty_data;
829fffb55fSDavid Gibson
83f858927fSRob Herring d = data_add_marker(d, TYPE_NONE, NULL);
849fffb55fSDavid Gibson while (!feof(f) && (d.len < maxlen)) {
859fffb55fSDavid Gibson size_t chunksize, ret;
869fffb55fSDavid Gibson
87*79edff12SRob Herring if (maxlen == (size_t)-1)
889fffb55fSDavid Gibson chunksize = 4096;
899fffb55fSDavid Gibson else
909fffb55fSDavid Gibson chunksize = maxlen - d.len;
919fffb55fSDavid Gibson
929fffb55fSDavid Gibson d = data_grow_for(d, chunksize);
939fffb55fSDavid Gibson ret = fread(d.val + d.len, 1, chunksize, f);
949fffb55fSDavid Gibson
959fffb55fSDavid Gibson if (ferror(f))
969fffb55fSDavid Gibson die("Error reading file into data: %s", strerror(errno));
979fffb55fSDavid Gibson
989fffb55fSDavid Gibson if (d.len + ret < d.len)
999fffb55fSDavid Gibson die("Overflow reading file into data\n");
1009fffb55fSDavid Gibson
1019fffb55fSDavid Gibson d.len += ret;
1029fffb55fSDavid Gibson }
1039fffb55fSDavid Gibson
1049fffb55fSDavid Gibson return d;
1059fffb55fSDavid Gibson }
1069fffb55fSDavid Gibson
data_append_data(struct data d,const void * p,int len)1079fffb55fSDavid Gibson struct data data_append_data(struct data d, const void *p, int len)
1089fffb55fSDavid Gibson {
1099fffb55fSDavid Gibson d = data_grow_for(d, len);
1109fffb55fSDavid Gibson memcpy(d.val + d.len, p, len);
1119fffb55fSDavid Gibson d.len += len;
1129fffb55fSDavid Gibson return d;
1139fffb55fSDavid Gibson }
1149fffb55fSDavid Gibson
data_insert_at_marker(struct data d,struct marker * m,const void * p,int len)1159fffb55fSDavid Gibson struct data data_insert_at_marker(struct data d, struct marker *m,
1169fffb55fSDavid Gibson const void *p, int len)
1179fffb55fSDavid Gibson {
1189fffb55fSDavid Gibson d = data_grow_for(d, len);
1199fffb55fSDavid Gibson memmove(d.val + m->offset + len, d.val + m->offset, d.len - m->offset);
1209fffb55fSDavid Gibson memcpy(d.val + m->offset, p, len);
1219fffb55fSDavid Gibson d.len += len;
1229fffb55fSDavid Gibson
1239fffb55fSDavid Gibson /* Adjust all markers after the one we're inserting at */
1249fffb55fSDavid Gibson m = m->next;
1259fffb55fSDavid Gibson for_each_marker(m)
1269fffb55fSDavid Gibson m->offset += len;
1279fffb55fSDavid Gibson return d;
1289fffb55fSDavid Gibson }
1299fffb55fSDavid Gibson
data_append_markers(struct data d,struct marker * m)1305ccd9915SJosh Triplett static struct data data_append_markers(struct data d, struct marker *m)
1319fffb55fSDavid Gibson {
1329fffb55fSDavid Gibson struct marker **mp = &d.markers;
1339fffb55fSDavid Gibson
1349fffb55fSDavid Gibson /* Find the end of the markerlist */
1359fffb55fSDavid Gibson while (*mp)
1369fffb55fSDavid Gibson mp = &((*mp)->next);
1379fffb55fSDavid Gibson *mp = m;
1389fffb55fSDavid Gibson return d;
1399fffb55fSDavid Gibson }
1409fffb55fSDavid Gibson
data_merge(struct data d1,struct data d2)1419fffb55fSDavid Gibson struct data data_merge(struct data d1, struct data d2)
1429fffb55fSDavid Gibson {
1439fffb55fSDavid Gibson struct data d;
1449fffb55fSDavid Gibson struct marker *m2 = d2.markers;
1459fffb55fSDavid Gibson
1469fffb55fSDavid Gibson d = data_append_markers(data_append_data(d1, d2.val, d2.len), m2);
1479fffb55fSDavid Gibson
1489fffb55fSDavid Gibson /* Adjust for the length of d1 */
1499fffb55fSDavid Gibson for_each_marker(m2)
1509fffb55fSDavid Gibson m2->offset += d1.len;
1519fffb55fSDavid Gibson
1529fffb55fSDavid Gibson d2.markers = NULL; /* So data_free() doesn't clobber them */
1539fffb55fSDavid Gibson data_free(d2);
1549fffb55fSDavid Gibson
1559fffb55fSDavid Gibson return d;
1569fffb55fSDavid Gibson }
1579fffb55fSDavid Gibson
data_append_integer(struct data d,uint64_t value,int bits)158cd296721SStephen Warren struct data data_append_integer(struct data d, uint64_t value, int bits)
1599fffb55fSDavid Gibson {
160cd296721SStephen Warren uint8_t value_8;
16189d12310SRob Herring fdt16_t value_16;
16289d12310SRob Herring fdt32_t value_32;
16389d12310SRob Herring fdt64_t value_64;
1649fffb55fSDavid Gibson
165cd296721SStephen Warren switch (bits) {
166cd296721SStephen Warren case 8:
167cd296721SStephen Warren value_8 = value;
168cd296721SStephen Warren return data_append_data(d, &value_8, 1);
169cd296721SStephen Warren
170cd296721SStephen Warren case 16:
171cd296721SStephen Warren value_16 = cpu_to_fdt16(value);
172cd296721SStephen Warren return data_append_data(d, &value_16, 2);
173cd296721SStephen Warren
174cd296721SStephen Warren case 32:
175cd296721SStephen Warren value_32 = cpu_to_fdt32(value);
176cd296721SStephen Warren return data_append_data(d, &value_32, 4);
177cd296721SStephen Warren
178cd296721SStephen Warren case 64:
179cd296721SStephen Warren value_64 = cpu_to_fdt64(value);
180cd296721SStephen Warren return data_append_data(d, &value_64, 8);
181cd296721SStephen Warren
182cd296721SStephen Warren default:
183cd296721SStephen Warren die("Invalid literal size (%d)\n", bits);
184cd296721SStephen Warren }
1859fffb55fSDavid Gibson }
1869fffb55fSDavid Gibson
data_append_re(struct data d,uint64_t address,uint64_t size)18789d12310SRob Herring struct data data_append_re(struct data d, uint64_t address, uint64_t size)
1889fffb55fSDavid Gibson {
18989d12310SRob Herring struct fdt_reserve_entry re;
1909fffb55fSDavid Gibson
19189d12310SRob Herring re.address = cpu_to_fdt64(address);
19289d12310SRob Herring re.size = cpu_to_fdt64(size);
1939fffb55fSDavid Gibson
19489d12310SRob Herring return data_append_data(d, &re, sizeof(re));
1959fffb55fSDavid Gibson }
1969fffb55fSDavid Gibson
data_append_cell(struct data d,cell_t word)197cd296721SStephen Warren struct data data_append_cell(struct data d, cell_t word)
198cd296721SStephen Warren {
199cd296721SStephen Warren return data_append_integer(d, word, sizeof(word) * 8);
200cd296721SStephen Warren }
201cd296721SStephen Warren
data_append_addr(struct data d,uint64_t addr)2029fffb55fSDavid Gibson struct data data_append_addr(struct data d, uint64_t addr)
2039fffb55fSDavid Gibson {
204cd296721SStephen Warren return data_append_integer(d, addr, sizeof(addr) * 8);
2059fffb55fSDavid Gibson }
2069fffb55fSDavid Gibson
data_append_byte(struct data d,uint8_t byte)2079fffb55fSDavid Gibson struct data data_append_byte(struct data d, uint8_t byte)
2089fffb55fSDavid Gibson {
2099fffb55fSDavid Gibson return data_append_data(d, &byte, 1);
2109fffb55fSDavid Gibson }
2119fffb55fSDavid Gibson
data_append_zeroes(struct data d,int len)2129fffb55fSDavid Gibson struct data data_append_zeroes(struct data d, int len)
2139fffb55fSDavid Gibson {
2149fffb55fSDavid Gibson d = data_grow_for(d, len);
2159fffb55fSDavid Gibson
2169fffb55fSDavid Gibson memset(d.val + d.len, 0, len);
2179fffb55fSDavid Gibson d.len += len;
2189fffb55fSDavid Gibson return d;
2199fffb55fSDavid Gibson }
2209fffb55fSDavid Gibson
data_append_align(struct data d,int align)2219fffb55fSDavid Gibson struct data data_append_align(struct data d, int align)
2229fffb55fSDavid Gibson {
2239fffb55fSDavid Gibson int newlen = ALIGN(d.len, align);
2249fffb55fSDavid Gibson return data_append_zeroes(d, newlen - d.len);
2259fffb55fSDavid Gibson }
2269fffb55fSDavid Gibson
data_add_marker(struct data d,enum markertype type,char * ref)2279fffb55fSDavid Gibson struct data data_add_marker(struct data d, enum markertype type, char *ref)
2289fffb55fSDavid Gibson {
2299fffb55fSDavid Gibson struct marker *m;
2309fffb55fSDavid Gibson
2319fffb55fSDavid Gibson m = xmalloc(sizeof(*m));
2329fffb55fSDavid Gibson m->offset = d.len;
2339fffb55fSDavid Gibson m->type = type;
2349fffb55fSDavid Gibson m->ref = ref;
2359fffb55fSDavid Gibson m->next = NULL;
2369fffb55fSDavid Gibson
2379fffb55fSDavid Gibson return data_append_markers(d, m);
2389fffb55fSDavid Gibson }
2399fffb55fSDavid Gibson
data_is_one_string(struct data d)24047605971SRob Herring bool data_is_one_string(struct data d)
2419fffb55fSDavid Gibson {
2429fffb55fSDavid Gibson int i;
2439fffb55fSDavid Gibson int len = d.len;
2449fffb55fSDavid Gibson
2459fffb55fSDavid Gibson if (len == 0)
24647605971SRob Herring return false;
2479fffb55fSDavid Gibson
2489fffb55fSDavid Gibson for (i = 0; i < len-1; i++)
2499fffb55fSDavid Gibson if (d.val[i] == '\0')
25047605971SRob Herring return false;
2519fffb55fSDavid Gibson
2529fffb55fSDavid Gibson if (d.val[len-1] != '\0')
25347605971SRob Herring return false;
2549fffb55fSDavid Gibson
25547605971SRob Herring return true;
2569fffb55fSDavid Gibson }
257