forked from luck/tmp_suning_uos_patched
f858927fd6
Major changes are I2C and SPI bus checks, YAML output format (for future validation), some new libfdt functions, and more libfdt validation of dtbs. The YAML addition adds an optional dependency on libyaml. pkg-config is used to test for it and pkg-config became a kconfig dependency in 4.18. This adds the following commits from upstream: c86da84d30e4 Add support for YAML encoded output 361b5e7d8067 Make type_marker_length helper public bfbfab047e45 pylibfdt: Add a means to add and delete notes 9005f4108e7c pylibfdt: Allow delprop() to return errors b94c056b137e Make valgrind optional fd06c54d4711 tests: Better testing of dtc -I fs mode c3f50c9a86d9 tests: Allow dtbs_equal_unordered to ignore mem reserves 0ac9fdee37c7 dtc: trivial '-I fs -O dts' test 0fd1c8c783f3 pylibfdt: fdt_get_mem_rsv returns 2 uint64_t values 04853cad18f4 pylibfdt: Don't incorrectly / unnecessarily override uint64_t typemap 9619c8619c37 Kill bogus TYPE_BLOB marker type ac68ff92ae20 parser: add TYPE_STRING marker to path references 90a190eb04d9 checks: add SPI bus checks 53a1bd546905 checks: add I2C bus checks 88f18909db73 dtc: Bump version to v1.4.7 85bce8b2f06d tests: Correction to vg_prepare_blob() 57f7f9e7bc7c tests: Don't call memcmp() with NULL arguments c12b2b0c20eb libfdt: fdt_address_cells() and fdt_size_cells() 3fe0eeda0b7f livetree: Set phandle properties type to uint32 853649acceba pylibfdt: Support the sequential-write interface 9b0e4fe26093 tests: Improve fdt_resize() tests 1087504bb3e8 libfdt: Add necessary header padding in fdt_create() c72fa777e613 libfdt: Copy the struct region in fdt_resize() 32b9c6130762 Preserve datatype markers when emitting dts format 6dcb8ba408ec libfdt: Add helpers for accessing unaligned words 42607f21d43e tests: Fix incorrect check name 'prop_name_chars' 9d78c33bf8a1 tests: fix grep for checks error messages b770f3d1c13f pylibfdt: Support setting the name of a node 2f0d07e678e0 pylibfdt: Add functions to set and get properties as strings 354d3dc55939 pylibfdt: Update the bytearray size with pack() 3c374d46acce pylibfdt: Allow reading integer values from properties 49d32ce40bb4 pylibfdt: Use an unsigned type for fdt32_t 481246a0c13a pylibfdt: Avoid accessing the internal _fdt member in tests 9aafa33d99ed pylibfdt: Add functions to update properties 5a598671fdbf pylibfdt: Support device-tree creation/expansion 483e170625e1 pylibfdt: Add support for reading the memory reserve map 29bb05aa4200 pylibfdt: Add support for the rest of the header functions 582a7159a5d0 pylibfdt: Add support for fdt_next_node() f0f8c9169819 pylibfdt: Reorder functions to match libfdt.h 64a69d123935 pylibfdt: Return string instead of bytearray from getprop() 4d09a83420df fdtput: Add documentation e617cbe1bd67 fdtget: Add documentation 180a93924014 Use <inttypes.h> format specifiers in a bunch of places we should b9af3b396576 scripts/dtc: Fixed format mismatch in fprintf 4b8fcc3d015c libfdt: Add fdt_check_full() function c14223fb2292 tests: Use valgrind client requests for better checking 5b67d2b955a3 tests: Better handling of valgrind errors saving blobs e2556aaeb506 tests: Remove unused #define fb9c6abddaa8 Use size_t for blob lengths in utilfdt_read* 0112fda03bf6 libfdt: Add fdt_header_size() 6473a21d8bfe Consolidate utilfdt_read_len() variants d5db5382c5e5 libfdt: Safer access to memory reservations 719d582e98ec libfdt: Propagate name errors in fdt_getprop_by_offset() 70166d62a27f libfdt: Safer access to strings section eb890c0f77dc libfdt: Make fdt_check_header() more thorough 899d6fad93f3 libfdt: Improve sequential write state checking 04b5b4062ccd libfdt: Clean up header checking functions 44d3efedc816 Preserve datatype information when parsing dts f0be81bd8de0 Make Property a subclass of bytearray 24b1f3f064d4 pylibfdt: Add a method to access the device tree directly Signed-off-by: Rob Herring <robh@kernel.org>
923 lines
20 KiB
C
923 lines
20 KiB
C
/*
|
|
* libfdt - Flat Device Tree manipulation
|
|
* Copyright (C) 2006 David Gibson, IBM Corporation.
|
|
*
|
|
* libfdt is dual licensed: you can use it either under the terms of
|
|
* the GPL, or the BSD license, at your option.
|
|
*
|
|
* a) This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of the
|
|
* License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public
|
|
* License along with this library; if not, write to the Free
|
|
* Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
|
|
* MA 02110-1301 USA
|
|
*
|
|
* Alternatively,
|
|
*
|
|
* b) Redistribution and use in source and binary forms, with or
|
|
* without modification, are permitted provided that the following
|
|
* conditions are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer in the documentation and/or other materials
|
|
* provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
|
|
* CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,
|
|
* INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
|
|
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
|
|
* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
#include "libfdt_env.h"
|
|
|
|
#include <fdt.h>
|
|
#include <libfdt.h>
|
|
|
|
#include "libfdt_internal.h"
|
|
|
|
static int fdt_nodename_eq_(const void *fdt, int offset,
|
|
const char *s, int len)
|
|
{
|
|
int olen;
|
|
const char *p = fdt_get_name(fdt, offset, &olen);
|
|
|
|
if (!p || olen < len)
|
|
/* short match */
|
|
return 0;
|
|
|
|
if (memcmp(p, s, len) != 0)
|
|
return 0;
|
|
|
|
if (p[len] == '\0')
|
|
return 1;
|
|
else if (!memchr(s, '@', len) && (p[len] == '@'))
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
const char *fdt_get_string(const void *fdt, int stroffset, int *lenp)
|
|
{
|
|
uint32_t absoffset = stroffset + fdt_off_dt_strings(fdt);
|
|
size_t len;
|
|
int err;
|
|
const char *s, *n;
|
|
|
|
err = fdt_ro_probe_(fdt);
|
|
if (err != 0)
|
|
goto fail;
|
|
|
|
err = -FDT_ERR_BADOFFSET;
|
|
if (absoffset >= fdt_totalsize(fdt))
|
|
goto fail;
|
|
len = fdt_totalsize(fdt) - absoffset;
|
|
|
|
if (fdt_magic(fdt) == FDT_MAGIC) {
|
|
if (stroffset < 0)
|
|
goto fail;
|
|
if (fdt_version(fdt) >= 17) {
|
|
if (stroffset >= fdt_size_dt_strings(fdt))
|
|
goto fail;
|
|
if ((fdt_size_dt_strings(fdt) - stroffset) < len)
|
|
len = fdt_size_dt_strings(fdt) - stroffset;
|
|
}
|
|
} else if (fdt_magic(fdt) == FDT_SW_MAGIC) {
|
|
if ((stroffset >= 0)
|
|
|| (stroffset < -fdt_size_dt_strings(fdt)))
|
|
goto fail;
|
|
if ((-stroffset) < len)
|
|
len = -stroffset;
|
|
} else {
|
|
err = -FDT_ERR_INTERNAL;
|
|
goto fail;
|
|
}
|
|
|
|
s = (const char *)fdt + absoffset;
|
|
n = memchr(s, '\0', len);
|
|
if (!n) {
|
|
/* missing terminating NULL */
|
|
err = -FDT_ERR_TRUNCATED;
|
|
goto fail;
|
|
}
|
|
|
|
if (lenp)
|
|
*lenp = n - s;
|
|
return s;
|
|
|
|
fail:
|
|
if (lenp)
|
|
*lenp = err;
|
|
return NULL;
|
|
}
|
|
|
|
const char *fdt_string(const void *fdt, int stroffset)
|
|
{
|
|
return fdt_get_string(fdt, stroffset, NULL);
|
|
}
|
|
|
|
static int fdt_string_eq_(const void *fdt, int stroffset,
|
|
const char *s, int len)
|
|
{
|
|
int slen;
|
|
const char *p = fdt_get_string(fdt, stroffset, &slen);
|
|
|
|
return p && (slen == len) && (memcmp(p, s, len) == 0);
|
|
}
|
|
|
|
uint32_t fdt_get_max_phandle(const void *fdt)
|
|
{
|
|
uint32_t max_phandle = 0;
|
|
int offset;
|
|
|
|
for (offset = fdt_next_node(fdt, -1, NULL);;
|
|
offset = fdt_next_node(fdt, offset, NULL)) {
|
|
uint32_t phandle;
|
|
|
|
if (offset == -FDT_ERR_NOTFOUND)
|
|
return max_phandle;
|
|
|
|
if (offset < 0)
|
|
return (uint32_t)-1;
|
|
|
|
phandle = fdt_get_phandle(fdt, offset);
|
|
if (phandle == (uint32_t)-1)
|
|
continue;
|
|
|
|
if (phandle > max_phandle)
|
|
max_phandle = phandle;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct fdt_reserve_entry *fdt_mem_rsv(const void *fdt, int n)
|
|
{
|
|
int offset = n * sizeof(struct fdt_reserve_entry);
|
|
int absoffset = fdt_off_mem_rsvmap(fdt) + offset;
|
|
|
|
if (absoffset < fdt_off_mem_rsvmap(fdt))
|
|
return NULL;
|
|
if (absoffset > fdt_totalsize(fdt) - sizeof(struct fdt_reserve_entry))
|
|
return NULL;
|
|
return fdt_mem_rsv_(fdt, n);
|
|
}
|
|
|
|
int fdt_get_mem_rsv(const void *fdt, int n, uint64_t *address, uint64_t *size)
|
|
{
|
|
const struct fdt_reserve_entry *re;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
re = fdt_mem_rsv(fdt, n);
|
|
if (!re)
|
|
return -FDT_ERR_BADOFFSET;
|
|
|
|
*address = fdt64_ld(&re->address);
|
|
*size = fdt64_ld(&re->size);
|
|
return 0;
|
|
}
|
|
|
|
int fdt_num_mem_rsv(const void *fdt)
|
|
{
|
|
int i;
|
|
const struct fdt_reserve_entry *re;
|
|
|
|
for (i = 0; (re = fdt_mem_rsv(fdt, i)) != NULL; i++) {
|
|
if (fdt64_ld(&re->size) == 0)
|
|
return i;
|
|
}
|
|
return -FDT_ERR_TRUNCATED;
|
|
}
|
|
|
|
static int nextprop_(const void *fdt, int offset)
|
|
{
|
|
uint32_t tag;
|
|
int nextoffset;
|
|
|
|
do {
|
|
tag = fdt_next_tag(fdt, offset, &nextoffset);
|
|
|
|
switch (tag) {
|
|
case FDT_END:
|
|
if (nextoffset >= 0)
|
|
return -FDT_ERR_BADSTRUCTURE;
|
|
else
|
|
return nextoffset;
|
|
|
|
case FDT_PROP:
|
|
return offset;
|
|
}
|
|
offset = nextoffset;
|
|
} while (tag == FDT_NOP);
|
|
|
|
return -FDT_ERR_NOTFOUND;
|
|
}
|
|
|
|
int fdt_subnode_offset_namelen(const void *fdt, int offset,
|
|
const char *name, int namelen)
|
|
{
|
|
int depth;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
|
|
for (depth = 0;
|
|
(offset >= 0) && (depth >= 0);
|
|
offset = fdt_next_node(fdt, offset, &depth))
|
|
if ((depth == 1)
|
|
&& fdt_nodename_eq_(fdt, offset, name, namelen))
|
|
return offset;
|
|
|
|
if (depth < 0)
|
|
return -FDT_ERR_NOTFOUND;
|
|
return offset; /* error */
|
|
}
|
|
|
|
int fdt_subnode_offset(const void *fdt, int parentoffset,
|
|
const char *name)
|
|
{
|
|
return fdt_subnode_offset_namelen(fdt, parentoffset, name, strlen(name));
|
|
}
|
|
|
|
int fdt_path_offset_namelen(const void *fdt, const char *path, int namelen)
|
|
{
|
|
const char *end = path + namelen;
|
|
const char *p = path;
|
|
int offset = 0;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
|
|
/* see if we have an alias */
|
|
if (*path != '/') {
|
|
const char *q = memchr(path, '/', end - p);
|
|
|
|
if (!q)
|
|
q = end;
|
|
|
|
p = fdt_get_alias_namelen(fdt, p, q - p);
|
|
if (!p)
|
|
return -FDT_ERR_BADPATH;
|
|
offset = fdt_path_offset(fdt, p);
|
|
|
|
p = q;
|
|
}
|
|
|
|
while (p < end) {
|
|
const char *q;
|
|
|
|
while (*p == '/') {
|
|
p++;
|
|
if (p == end)
|
|
return offset;
|
|
}
|
|
q = memchr(p, '/', end - p);
|
|
if (! q)
|
|
q = end;
|
|
|
|
offset = fdt_subnode_offset_namelen(fdt, offset, p, q-p);
|
|
if (offset < 0)
|
|
return offset;
|
|
|
|
p = q;
|
|
}
|
|
|
|
return offset;
|
|
}
|
|
|
|
int fdt_path_offset(const void *fdt, const char *path)
|
|
{
|
|
return fdt_path_offset_namelen(fdt, path, strlen(path));
|
|
}
|
|
|
|
const char *fdt_get_name(const void *fdt, int nodeoffset, int *len)
|
|
{
|
|
const struct fdt_node_header *nh = fdt_offset_ptr_(fdt, nodeoffset);
|
|
const char *nameptr;
|
|
int err;
|
|
|
|
if (((err = fdt_ro_probe_(fdt)) != 0)
|
|
|| ((err = fdt_check_node_offset_(fdt, nodeoffset)) < 0))
|
|
goto fail;
|
|
|
|
nameptr = nh->name;
|
|
|
|
if (fdt_version(fdt) < 0x10) {
|
|
/*
|
|
* For old FDT versions, match the naming conventions of V16:
|
|
* give only the leaf name (after all /). The actual tree
|
|
* contents are loosely checked.
|
|
*/
|
|
const char *leaf;
|
|
leaf = strrchr(nameptr, '/');
|
|
if (leaf == NULL) {
|
|
err = -FDT_ERR_BADSTRUCTURE;
|
|
goto fail;
|
|
}
|
|
nameptr = leaf+1;
|
|
}
|
|
|
|
if (len)
|
|
*len = strlen(nameptr);
|
|
|
|
return nameptr;
|
|
|
|
fail:
|
|
if (len)
|
|
*len = err;
|
|
return NULL;
|
|
}
|
|
|
|
int fdt_first_property_offset(const void *fdt, int nodeoffset)
|
|
{
|
|
int offset;
|
|
|
|
if ((offset = fdt_check_node_offset_(fdt, nodeoffset)) < 0)
|
|
return offset;
|
|
|
|
return nextprop_(fdt, offset);
|
|
}
|
|
|
|
int fdt_next_property_offset(const void *fdt, int offset)
|
|
{
|
|
if ((offset = fdt_check_prop_offset_(fdt, offset)) < 0)
|
|
return offset;
|
|
|
|
return nextprop_(fdt, offset);
|
|
}
|
|
|
|
static const struct fdt_property *fdt_get_property_by_offset_(const void *fdt,
|
|
int offset,
|
|
int *lenp)
|
|
{
|
|
int err;
|
|
const struct fdt_property *prop;
|
|
|
|
if ((err = fdt_check_prop_offset_(fdt, offset)) < 0) {
|
|
if (lenp)
|
|
*lenp = err;
|
|
return NULL;
|
|
}
|
|
|
|
prop = fdt_offset_ptr_(fdt, offset);
|
|
|
|
if (lenp)
|
|
*lenp = fdt32_ld(&prop->len);
|
|
|
|
return prop;
|
|
}
|
|
|
|
const struct fdt_property *fdt_get_property_by_offset(const void *fdt,
|
|
int offset,
|
|
int *lenp)
|
|
{
|
|
/* Prior to version 16, properties may need realignment
|
|
* and this API does not work. fdt_getprop_*() will, however. */
|
|
|
|
if (fdt_version(fdt) < 0x10) {
|
|
if (lenp)
|
|
*lenp = -FDT_ERR_BADVERSION;
|
|
return NULL;
|
|
}
|
|
|
|
return fdt_get_property_by_offset_(fdt, offset, lenp);
|
|
}
|
|
|
|
static const struct fdt_property *fdt_get_property_namelen_(const void *fdt,
|
|
int offset,
|
|
const char *name,
|
|
int namelen,
|
|
int *lenp,
|
|
int *poffset)
|
|
{
|
|
for (offset = fdt_first_property_offset(fdt, offset);
|
|
(offset >= 0);
|
|
(offset = fdt_next_property_offset(fdt, offset))) {
|
|
const struct fdt_property *prop;
|
|
|
|
if (!(prop = fdt_get_property_by_offset_(fdt, offset, lenp))) {
|
|
offset = -FDT_ERR_INTERNAL;
|
|
break;
|
|
}
|
|
if (fdt_string_eq_(fdt, fdt32_ld(&prop->nameoff),
|
|
name, namelen)) {
|
|
if (poffset)
|
|
*poffset = offset;
|
|
return prop;
|
|
}
|
|
}
|
|
|
|
if (lenp)
|
|
*lenp = offset;
|
|
return NULL;
|
|
}
|
|
|
|
|
|
const struct fdt_property *fdt_get_property_namelen(const void *fdt,
|
|
int offset,
|
|
const char *name,
|
|
int namelen, int *lenp)
|
|
{
|
|
/* Prior to version 16, properties may need realignment
|
|
* and this API does not work. fdt_getprop_*() will, however. */
|
|
if (fdt_version(fdt) < 0x10) {
|
|
if (lenp)
|
|
*lenp = -FDT_ERR_BADVERSION;
|
|
return NULL;
|
|
}
|
|
|
|
return fdt_get_property_namelen_(fdt, offset, name, namelen, lenp,
|
|
NULL);
|
|
}
|
|
|
|
|
|
const struct fdt_property *fdt_get_property(const void *fdt,
|
|
int nodeoffset,
|
|
const char *name, int *lenp)
|
|
{
|
|
return fdt_get_property_namelen(fdt, nodeoffset, name,
|
|
strlen(name), lenp);
|
|
}
|
|
|
|
const void *fdt_getprop_namelen(const void *fdt, int nodeoffset,
|
|
const char *name, int namelen, int *lenp)
|
|
{
|
|
int poffset;
|
|
const struct fdt_property *prop;
|
|
|
|
prop = fdt_get_property_namelen_(fdt, nodeoffset, name, namelen, lenp,
|
|
&poffset);
|
|
if (!prop)
|
|
return NULL;
|
|
|
|
/* Handle realignment */
|
|
if (fdt_version(fdt) < 0x10 && (poffset + sizeof(*prop)) % 8 &&
|
|
fdt32_ld(&prop->len) >= 8)
|
|
return prop->data + 4;
|
|
return prop->data;
|
|
}
|
|
|
|
const void *fdt_getprop_by_offset(const void *fdt, int offset,
|
|
const char **namep, int *lenp)
|
|
{
|
|
const struct fdt_property *prop;
|
|
|
|
prop = fdt_get_property_by_offset_(fdt, offset, lenp);
|
|
if (!prop)
|
|
return NULL;
|
|
if (namep) {
|
|
const char *name;
|
|
int namelen;
|
|
name = fdt_get_string(fdt, fdt32_ld(&prop->nameoff),
|
|
&namelen);
|
|
if (!name) {
|
|
if (lenp)
|
|
*lenp = namelen;
|
|
return NULL;
|
|
}
|
|
*namep = name;
|
|
}
|
|
|
|
/* Handle realignment */
|
|
if (fdt_version(fdt) < 0x10 && (offset + sizeof(*prop)) % 8 &&
|
|
fdt32_ld(&prop->len) >= 8)
|
|
return prop->data + 4;
|
|
return prop->data;
|
|
}
|
|
|
|
const void *fdt_getprop(const void *fdt, int nodeoffset,
|
|
const char *name, int *lenp)
|
|
{
|
|
return fdt_getprop_namelen(fdt, nodeoffset, name, strlen(name), lenp);
|
|
}
|
|
|
|
uint32_t fdt_get_phandle(const void *fdt, int nodeoffset)
|
|
{
|
|
const fdt32_t *php;
|
|
int len;
|
|
|
|
/* FIXME: This is a bit sub-optimal, since we potentially scan
|
|
* over all the properties twice. */
|
|
php = fdt_getprop(fdt, nodeoffset, "phandle", &len);
|
|
if (!php || (len != sizeof(*php))) {
|
|
php = fdt_getprop(fdt, nodeoffset, "linux,phandle", &len);
|
|
if (!php || (len != sizeof(*php)))
|
|
return 0;
|
|
}
|
|
|
|
return fdt32_ld(php);
|
|
}
|
|
|
|
const char *fdt_get_alias_namelen(const void *fdt,
|
|
const char *name, int namelen)
|
|
{
|
|
int aliasoffset;
|
|
|
|
aliasoffset = fdt_path_offset(fdt, "/aliases");
|
|
if (aliasoffset < 0)
|
|
return NULL;
|
|
|
|
return fdt_getprop_namelen(fdt, aliasoffset, name, namelen, NULL);
|
|
}
|
|
|
|
const char *fdt_get_alias(const void *fdt, const char *name)
|
|
{
|
|
return fdt_get_alias_namelen(fdt, name, strlen(name));
|
|
}
|
|
|
|
int fdt_get_path(const void *fdt, int nodeoffset, char *buf, int buflen)
|
|
{
|
|
int pdepth = 0, p = 0;
|
|
int offset, depth, namelen;
|
|
const char *name;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
|
|
if (buflen < 2)
|
|
return -FDT_ERR_NOSPACE;
|
|
|
|
for (offset = 0, depth = 0;
|
|
(offset >= 0) && (offset <= nodeoffset);
|
|
offset = fdt_next_node(fdt, offset, &depth)) {
|
|
while (pdepth > depth) {
|
|
do {
|
|
p--;
|
|
} while (buf[p-1] != '/');
|
|
pdepth--;
|
|
}
|
|
|
|
if (pdepth >= depth) {
|
|
name = fdt_get_name(fdt, offset, &namelen);
|
|
if (!name)
|
|
return namelen;
|
|
if ((p + namelen + 1) <= buflen) {
|
|
memcpy(buf + p, name, namelen);
|
|
p += namelen;
|
|
buf[p++] = '/';
|
|
pdepth++;
|
|
}
|
|
}
|
|
|
|
if (offset == nodeoffset) {
|
|
if (pdepth < (depth + 1))
|
|
return -FDT_ERR_NOSPACE;
|
|
|
|
if (p > 1) /* special case so that root path is "/", not "" */
|
|
p--;
|
|
buf[p] = '\0';
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
if ((offset == -FDT_ERR_NOTFOUND) || (offset >= 0))
|
|
return -FDT_ERR_BADOFFSET;
|
|
else if (offset == -FDT_ERR_BADOFFSET)
|
|
return -FDT_ERR_BADSTRUCTURE;
|
|
|
|
return offset; /* error from fdt_next_node() */
|
|
}
|
|
|
|
int fdt_supernode_atdepth_offset(const void *fdt, int nodeoffset,
|
|
int supernodedepth, int *nodedepth)
|
|
{
|
|
int offset, depth;
|
|
int supernodeoffset = -FDT_ERR_INTERNAL;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
|
|
if (supernodedepth < 0)
|
|
return -FDT_ERR_NOTFOUND;
|
|
|
|
for (offset = 0, depth = 0;
|
|
(offset >= 0) && (offset <= nodeoffset);
|
|
offset = fdt_next_node(fdt, offset, &depth)) {
|
|
if (depth == supernodedepth)
|
|
supernodeoffset = offset;
|
|
|
|
if (offset == nodeoffset) {
|
|
if (nodedepth)
|
|
*nodedepth = depth;
|
|
|
|
if (supernodedepth > depth)
|
|
return -FDT_ERR_NOTFOUND;
|
|
else
|
|
return supernodeoffset;
|
|
}
|
|
}
|
|
|
|
if ((offset == -FDT_ERR_NOTFOUND) || (offset >= 0))
|
|
return -FDT_ERR_BADOFFSET;
|
|
else if (offset == -FDT_ERR_BADOFFSET)
|
|
return -FDT_ERR_BADSTRUCTURE;
|
|
|
|
return offset; /* error from fdt_next_node() */
|
|
}
|
|
|
|
int fdt_node_depth(const void *fdt, int nodeoffset)
|
|
{
|
|
int nodedepth;
|
|
int err;
|
|
|
|
err = fdt_supernode_atdepth_offset(fdt, nodeoffset, 0, &nodedepth);
|
|
if (err)
|
|
return (err < 0) ? err : -FDT_ERR_INTERNAL;
|
|
return nodedepth;
|
|
}
|
|
|
|
int fdt_parent_offset(const void *fdt, int nodeoffset)
|
|
{
|
|
int nodedepth = fdt_node_depth(fdt, nodeoffset);
|
|
|
|
if (nodedepth < 0)
|
|
return nodedepth;
|
|
return fdt_supernode_atdepth_offset(fdt, nodeoffset,
|
|
nodedepth - 1, NULL);
|
|
}
|
|
|
|
int fdt_node_offset_by_prop_value(const void *fdt, int startoffset,
|
|
const char *propname,
|
|
const void *propval, int proplen)
|
|
{
|
|
int offset;
|
|
const void *val;
|
|
int len;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
|
|
/* FIXME: The algorithm here is pretty horrible: we scan each
|
|
* property of a node in fdt_getprop(), then if that didn't
|
|
* find what we want, we scan over them again making our way
|
|
* to the next node. Still it's the easiest to implement
|
|
* approach; performance can come later. */
|
|
for (offset = fdt_next_node(fdt, startoffset, NULL);
|
|
offset >= 0;
|
|
offset = fdt_next_node(fdt, offset, NULL)) {
|
|
val = fdt_getprop(fdt, offset, propname, &len);
|
|
if (val && (len == proplen)
|
|
&& (memcmp(val, propval, len) == 0))
|
|
return offset;
|
|
}
|
|
|
|
return offset; /* error from fdt_next_node() */
|
|
}
|
|
|
|
int fdt_node_offset_by_phandle(const void *fdt, uint32_t phandle)
|
|
{
|
|
int offset;
|
|
|
|
if ((phandle == 0) || (phandle == -1))
|
|
return -FDT_ERR_BADPHANDLE;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
|
|
/* FIXME: The algorithm here is pretty horrible: we
|
|
* potentially scan each property of a node in
|
|
* fdt_get_phandle(), then if that didn't find what
|
|
* we want, we scan over them again making our way to the next
|
|
* node. Still it's the easiest to implement approach;
|
|
* performance can come later. */
|
|
for (offset = fdt_next_node(fdt, -1, NULL);
|
|
offset >= 0;
|
|
offset = fdt_next_node(fdt, offset, NULL)) {
|
|
if (fdt_get_phandle(fdt, offset) == phandle)
|
|
return offset;
|
|
}
|
|
|
|
return offset; /* error from fdt_next_node() */
|
|
}
|
|
|
|
int fdt_stringlist_contains(const char *strlist, int listlen, const char *str)
|
|
{
|
|
int len = strlen(str);
|
|
const char *p;
|
|
|
|
while (listlen >= len) {
|
|
if (memcmp(str, strlist, len+1) == 0)
|
|
return 1;
|
|
p = memchr(strlist, '\0', listlen);
|
|
if (!p)
|
|
return 0; /* malformed strlist.. */
|
|
listlen -= (p-strlist) + 1;
|
|
strlist = p + 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int fdt_stringlist_count(const void *fdt, int nodeoffset, const char *property)
|
|
{
|
|
const char *list, *end;
|
|
int length, count = 0;
|
|
|
|
list = fdt_getprop(fdt, nodeoffset, property, &length);
|
|
if (!list)
|
|
return length;
|
|
|
|
end = list + length;
|
|
|
|
while (list < end) {
|
|
length = strnlen(list, end - list) + 1;
|
|
|
|
/* Abort if the last string isn't properly NUL-terminated. */
|
|
if (list + length > end)
|
|
return -FDT_ERR_BADVALUE;
|
|
|
|
list += length;
|
|
count++;
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
int fdt_stringlist_search(const void *fdt, int nodeoffset, const char *property,
|
|
const char *string)
|
|
{
|
|
int length, len, idx = 0;
|
|
const char *list, *end;
|
|
|
|
list = fdt_getprop(fdt, nodeoffset, property, &length);
|
|
if (!list)
|
|
return length;
|
|
|
|
len = strlen(string) + 1;
|
|
end = list + length;
|
|
|
|
while (list < end) {
|
|
length = strnlen(list, end - list) + 1;
|
|
|
|
/* Abort if the last string isn't properly NUL-terminated. */
|
|
if (list + length > end)
|
|
return -FDT_ERR_BADVALUE;
|
|
|
|
if (length == len && memcmp(list, string, length) == 0)
|
|
return idx;
|
|
|
|
list += length;
|
|
idx++;
|
|
}
|
|
|
|
return -FDT_ERR_NOTFOUND;
|
|
}
|
|
|
|
const char *fdt_stringlist_get(const void *fdt, int nodeoffset,
|
|
const char *property, int idx,
|
|
int *lenp)
|
|
{
|
|
const char *list, *end;
|
|
int length;
|
|
|
|
list = fdt_getprop(fdt, nodeoffset, property, &length);
|
|
if (!list) {
|
|
if (lenp)
|
|
*lenp = length;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
end = list + length;
|
|
|
|
while (list < end) {
|
|
length = strnlen(list, end - list) + 1;
|
|
|
|
/* Abort if the last string isn't properly NUL-terminated. */
|
|
if (list + length > end) {
|
|
if (lenp)
|
|
*lenp = -FDT_ERR_BADVALUE;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
if (idx == 0) {
|
|
if (lenp)
|
|
*lenp = length - 1;
|
|
|
|
return list;
|
|
}
|
|
|
|
list += length;
|
|
idx--;
|
|
}
|
|
|
|
if (lenp)
|
|
*lenp = -FDT_ERR_NOTFOUND;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
int fdt_node_check_compatible(const void *fdt, int nodeoffset,
|
|
const char *compatible)
|
|
{
|
|
const void *prop;
|
|
int len;
|
|
|
|
prop = fdt_getprop(fdt, nodeoffset, "compatible", &len);
|
|
if (!prop)
|
|
return len;
|
|
|
|
return !fdt_stringlist_contains(prop, len, compatible);
|
|
}
|
|
|
|
int fdt_node_offset_by_compatible(const void *fdt, int startoffset,
|
|
const char *compatible)
|
|
{
|
|
int offset, err;
|
|
|
|
FDT_RO_PROBE(fdt);
|
|
|
|
/* FIXME: The algorithm here is pretty horrible: we scan each
|
|
* property of a node in fdt_node_check_compatible(), then if
|
|
* that didn't find what we want, we scan over them again
|
|
* making our way to the next node. Still it's the easiest to
|
|
* implement approach; performance can come later. */
|
|
for (offset = fdt_next_node(fdt, startoffset, NULL);
|
|
offset >= 0;
|
|
offset = fdt_next_node(fdt, offset, NULL)) {
|
|
err = fdt_node_check_compatible(fdt, offset, compatible);
|
|
if ((err < 0) && (err != -FDT_ERR_NOTFOUND))
|
|
return err;
|
|
else if (err == 0)
|
|
return offset;
|
|
}
|
|
|
|
return offset; /* error from fdt_next_node() */
|
|
}
|
|
|
|
int fdt_check_full(const void *fdt, size_t bufsize)
|
|
{
|
|
int err;
|
|
int num_memrsv;
|
|
int offset, nextoffset = 0;
|
|
uint32_t tag;
|
|
unsigned depth = 0;
|
|
const void *prop;
|
|
const char *propname;
|
|
|
|
if (bufsize < FDT_V1_SIZE)
|
|
return -FDT_ERR_TRUNCATED;
|
|
err = fdt_check_header(fdt);
|
|
if (err != 0)
|
|
return err;
|
|
if (bufsize < fdt_totalsize(fdt))
|
|
return -FDT_ERR_TRUNCATED;
|
|
|
|
num_memrsv = fdt_num_mem_rsv(fdt);
|
|
if (num_memrsv < 0)
|
|
return num_memrsv;
|
|
|
|
while (1) {
|
|
offset = nextoffset;
|
|
tag = fdt_next_tag(fdt, offset, &nextoffset);
|
|
|
|
if (nextoffset < 0)
|
|
return nextoffset;
|
|
|
|
switch (tag) {
|
|
case FDT_NOP:
|
|
break;
|
|
|
|
case FDT_END:
|
|
if (depth != 0)
|
|
return -FDT_ERR_BADSTRUCTURE;
|
|
return 0;
|
|
|
|
case FDT_BEGIN_NODE:
|
|
depth++;
|
|
if (depth > INT_MAX)
|
|
return -FDT_ERR_BADSTRUCTURE;
|
|
break;
|
|
|
|
case FDT_END_NODE:
|
|
if (depth == 0)
|
|
return -FDT_ERR_BADSTRUCTURE;
|
|
depth--;
|
|
break;
|
|
|
|
case FDT_PROP:
|
|
prop = fdt_getprop_by_offset(fdt, offset, &propname,
|
|
&err);
|
|
if (!prop)
|
|
return err;
|
|
break;
|
|
|
|
default:
|
|
return -FDT_ERR_INTERNAL;
|
|
}
|
|
}
|
|
}
|