xref: /DragonStub/apps/lib/libfdt/fdt_wip.c (revision 3e6106c4d60a23aae3c0740979c5e6fb728b63c3)
1 // SPDX-License-Identifier: (GPL-2.0-or-later OR BSD-2-Clause)
2 /*
3  * libfdt - Flat Device Tree manipulation
4  * Copyright (C) 2006 David Gibson, IBM Corporation.
5  */
6 #include "libfdt_env.h"
7 
8 #include <fdt.h>
9 #include <libfdt.h>
10 
11 #include "libfdt_internal.h"
12 
fdt_setprop_inplace_namelen_partial(void * fdt,int nodeoffset,const char * name,int namelen,uint32_t idx,const void * val,int len)13 int fdt_setprop_inplace_namelen_partial(void *fdt, int nodeoffset,
14 					const char *name, int namelen,
15 					uint32_t idx, const void *val,
16 					int len)
17 {
18 	void *propval;
19 	int proplen;
20 
21 	propval = fdt_getprop_namelen_w(fdt, nodeoffset, name, namelen,
22 					&proplen);
23 	if (!propval)
24 		return proplen;
25 
26 	if ((unsigned)proplen < (len + idx))
27 		return -FDT_ERR_NOSPACE;
28 
29 	memcpy((char *)propval + idx, val, len);
30 	return 0;
31 }
32 
fdt_setprop_inplace(void * fdt,int nodeoffset,const char * name,const void * val,int len)33 int fdt_setprop_inplace(void *fdt, int nodeoffset, const char *name,
34 			const void *val, int len)
35 {
36 	const void *propval;
37 	int proplen;
38 
39 	propval = fdt_getprop(fdt, nodeoffset, name, &proplen);
40 	if (!propval)
41 		return proplen;
42 
43 	if (proplen != len)
44 		return -FDT_ERR_NOSPACE;
45 
46 	return fdt_setprop_inplace_namelen_partial(fdt, nodeoffset, name,
47 						   strlen(name), 0,
48 						   val, len);
49 }
50 
fdt_nop_region_(void * start,int len)51 static void fdt_nop_region_(void *start, int len)
52 {
53 	fdt32_t *p;
54 
55 	for (p = start; (char *)p < ((char *)start + len); p++)
56 		*p = cpu_to_fdt32(FDT_NOP);
57 }
58 
fdt_nop_property(void * fdt,int nodeoffset,const char * name)59 int fdt_nop_property(void *fdt, int nodeoffset, const char *name)
60 {
61 	struct fdt_property *prop;
62 	int len;
63 
64 	prop = fdt_get_property_w(fdt, nodeoffset, name, &len);
65 	if (!prop)
66 		return len;
67 
68 	fdt_nop_region_(prop, len + sizeof(*prop));
69 
70 	return 0;
71 }
72 
fdt_node_end_offset_(void * fdt,int offset)73 int fdt_node_end_offset_(void *fdt, int offset)
74 {
75 	int depth = 0;
76 
77 	while ((offset >= 0) && (depth >= 0))
78 		offset = fdt_next_node(fdt, offset, &depth);
79 
80 	return offset;
81 }
82 
fdt_nop_node(void * fdt,int nodeoffset)83 int fdt_nop_node(void *fdt, int nodeoffset)
84 {
85 	int endoffset;
86 
87 	endoffset = fdt_node_end_offset_(fdt, nodeoffset);
88 	if (endoffset < 0)
89 		return endoffset;
90 
91 	fdt_nop_region_(fdt_offset_ptr_w(fdt, nodeoffset, 0),
92 			endoffset - nodeoffset);
93 	return 0;
94 }
95