fdt_wip.c revision 1.1.1.1.2.2 1 1.1.1.1.2.2 skrll /*
2 1.1.1.1.2.2 skrll * libfdt - Flat Device Tree manipulation
3 1.1.1.1.2.2 skrll * Copyright (C) 2006 David Gibson, IBM Corporation.
4 1.1.1.1.2.2 skrll *
5 1.1.1.1.2.2 skrll * libfdt is dual licensed: you can use it either under the terms of
6 1.1.1.1.2.2 skrll * the GPL, or the BSD license, at your option.
7 1.1.1.1.2.2 skrll *
8 1.1.1.1.2.2 skrll * a) This library is free software; you can redistribute it and/or
9 1.1.1.1.2.2 skrll * modify it under the terms of the GNU General Public License as
10 1.1.1.1.2.2 skrll * published by the Free Software Foundation; either version 2 of the
11 1.1.1.1.2.2 skrll * License, or (at your option) any later version.
12 1.1.1.1.2.2 skrll *
13 1.1.1.1.2.2 skrll * This library is distributed in the hope that it will be useful,
14 1.1.1.1.2.2 skrll * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 1.1.1.1.2.2 skrll * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 1.1.1.1.2.2 skrll * GNU General Public License for more details.
17 1.1.1.1.2.2 skrll *
18 1.1.1.1.2.2 skrll * You should have received a copy of the GNU General Public
19 1.1.1.1.2.2 skrll * License along with this library; if not, write to the Free
20 1.1.1.1.2.2 skrll * Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
21 1.1.1.1.2.2 skrll * MA 02110-1301 USA
22 1.1.1.1.2.2 skrll *
23 1.1.1.1.2.2 skrll * Alternatively,
24 1.1.1.1.2.2 skrll *
25 1.1.1.1.2.2 skrll * b) Redistribution and use in source and binary forms, with or
26 1.1.1.1.2.2 skrll * without modification, are permitted provided that the following
27 1.1.1.1.2.2 skrll * conditions are met:
28 1.1.1.1.2.2 skrll *
29 1.1.1.1.2.2 skrll * 1. Redistributions of source code must retain the above
30 1.1.1.1.2.2 skrll * copyright notice, this list of conditions and the following
31 1.1.1.1.2.2 skrll * disclaimer.
32 1.1.1.1.2.2 skrll * 2. Redistributions in binary form must reproduce the above
33 1.1.1.1.2.2 skrll * copyright notice, this list of conditions and the following
34 1.1.1.1.2.2 skrll * disclaimer in the documentation and/or other materials
35 1.1.1.1.2.2 skrll * provided with the distribution.
36 1.1.1.1.2.2 skrll *
37 1.1.1.1.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
38 1.1.1.1.2.2 skrll * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
39 1.1.1.1.2.2 skrll * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
40 1.1.1.1.2.2 skrll * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
41 1.1.1.1.2.2 skrll * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
42 1.1.1.1.2.2 skrll * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
43 1.1.1.1.2.2 skrll * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
44 1.1.1.1.2.2 skrll * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
45 1.1.1.1.2.2 skrll * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
46 1.1.1.1.2.2 skrll * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
47 1.1.1.1.2.2 skrll * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
48 1.1.1.1.2.2 skrll * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
49 1.1.1.1.2.2 skrll * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
50 1.1.1.1.2.2 skrll */
51 1.1.1.1.2.2 skrll #include "libfdt_env.h"
52 1.1.1.1.2.2 skrll
53 1.1.1.1.2.2 skrll #include <fdt.h>
54 1.1.1.1.2.2 skrll #include <libfdt.h>
55 1.1.1.1.2.2 skrll
56 1.1.1.1.2.2 skrll #include "libfdt_internal.h"
57 1.1.1.1.2.2 skrll
58 1.1.1.1.2.2 skrll int fdt_setprop_inplace(void *fdt, int nodeoffset, const char *name,
59 1.1.1.1.2.2 skrll const void *val, int len)
60 1.1.1.1.2.2 skrll {
61 1.1.1.1.2.2 skrll void *propval;
62 1.1.1.1.2.2 skrll int proplen;
63 1.1.1.1.2.2 skrll
64 1.1.1.1.2.2 skrll propval = fdt_getprop_w(fdt, nodeoffset, name, &proplen);
65 1.1.1.1.2.2 skrll if (! propval)
66 1.1.1.1.2.2 skrll return proplen;
67 1.1.1.1.2.2 skrll
68 1.1.1.1.2.2 skrll if (proplen != len)
69 1.1.1.1.2.2 skrll return -FDT_ERR_NOSPACE;
70 1.1.1.1.2.2 skrll
71 1.1.1.1.2.2 skrll memcpy(propval, val, len);
72 1.1.1.1.2.2 skrll return 0;
73 1.1.1.1.2.2 skrll }
74 1.1.1.1.2.2 skrll
75 1.1.1.1.2.2 skrll static void _fdt_nop_region(void *start, int len)
76 1.1.1.1.2.2 skrll {
77 1.1.1.1.2.2 skrll fdt32_t *p;
78 1.1.1.1.2.2 skrll
79 1.1.1.1.2.2 skrll for (p = start; (char *)p < ((char *)start + len); p++)
80 1.1.1.1.2.2 skrll *p = cpu_to_fdt32(FDT_NOP);
81 1.1.1.1.2.2 skrll }
82 1.1.1.1.2.2 skrll
83 1.1.1.1.2.2 skrll int fdt_nop_property(void *fdt, int nodeoffset, const char *name)
84 1.1.1.1.2.2 skrll {
85 1.1.1.1.2.2 skrll struct fdt_property *prop;
86 1.1.1.1.2.2 skrll int len;
87 1.1.1.1.2.2 skrll
88 1.1.1.1.2.2 skrll prop = fdt_get_property_w(fdt, nodeoffset, name, &len);
89 1.1.1.1.2.2 skrll if (! prop)
90 1.1.1.1.2.2 skrll return len;
91 1.1.1.1.2.2 skrll
92 1.1.1.1.2.2 skrll _fdt_nop_region(prop, len + sizeof(*prop));
93 1.1.1.1.2.2 skrll
94 1.1.1.1.2.2 skrll return 0;
95 1.1.1.1.2.2 skrll }
96 1.1.1.1.2.2 skrll
97 1.1.1.1.2.2 skrll int _fdt_node_end_offset(void *fdt, int offset)
98 1.1.1.1.2.2 skrll {
99 1.1.1.1.2.2 skrll int depth = 0;
100 1.1.1.1.2.2 skrll
101 1.1.1.1.2.2 skrll while ((offset >= 0) && (depth >= 0))
102 1.1.1.1.2.2 skrll offset = fdt_next_node(fdt, offset, &depth);
103 1.1.1.1.2.2 skrll
104 1.1.1.1.2.2 skrll return offset;
105 1.1.1.1.2.2 skrll }
106 1.1.1.1.2.2 skrll
107 1.1.1.1.2.2 skrll int fdt_nop_node(void *fdt, int nodeoffset)
108 1.1.1.1.2.2 skrll {
109 1.1.1.1.2.2 skrll int endoffset;
110 1.1.1.1.2.2 skrll
111 1.1.1.1.2.2 skrll endoffset = _fdt_node_end_offset(fdt, nodeoffset);
112 1.1.1.1.2.2 skrll if (endoffset < 0)
113 1.1.1.1.2.2 skrll return endoffset;
114 1.1.1.1.2.2 skrll
115 1.1.1.1.2.2 skrll _fdt_nop_region(fdt_offset_ptr_w(fdt, nodeoffset, 0),
116 1.1.1.1.2.2 skrll endoffset - nodeoffset);
117 1.1.1.1.2.2 skrll return 0;
118 1.1.1.1.2.2 skrll }
119