| .. | .. |
|---|
| 1 | +// SPDX-License-Identifier: (GPL-2.0-or-later OR BSD-2-Clause) |
|---|
| 1 | 2 | /* |
|---|
| 2 | 3 | * libfdt - Flat Device Tree manipulation |
|---|
| 3 | 4 | * Copyright (C) 2014 David Gibson <david@gibson.dropbear.id.au> |
|---|
| 4 | | - * |
|---|
| 5 | | - * libfdt is dual licensed: you can use it either under the terms of |
|---|
| 6 | | - * the GPL, or the BSD license, at your option. |
|---|
| 7 | | - * |
|---|
| 8 | | - * a) This library is free software; you can redistribute it and/or |
|---|
| 9 | | - * modify it under the terms of the GNU General Public License as |
|---|
| 10 | | - * published by the Free Software Foundation; either version 2 of the |
|---|
| 11 | | - * License, or (at your option) any later version. |
|---|
| 12 | | - * |
|---|
| 13 | | - * This library is distributed in the hope that it will be useful, |
|---|
| 14 | | - * but WITHOUT ANY WARRANTY; without even the implied warranty of |
|---|
| 15 | | - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|---|
| 16 | | - * GNU General Public License for more details. |
|---|
| 17 | | - * |
|---|
| 18 | | - * You should have received a copy of the GNU General Public |
|---|
| 19 | | - * License along with this library; if not, write to the Free |
|---|
| 20 | | - * Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, |
|---|
| 21 | | - * MA 02110-1301 USA |
|---|
| 22 | | - * |
|---|
| 23 | | - * Alternatively, |
|---|
| 24 | | - * |
|---|
| 25 | | - * b) Redistribution and use in source and binary forms, with or |
|---|
| 26 | | - * without modification, are permitted provided that the following |
|---|
| 27 | | - * conditions are met: |
|---|
| 28 | | - * |
|---|
| 29 | | - * 1. Redistributions of source code must retain the above |
|---|
| 30 | | - * copyright notice, this list of conditions and the following |
|---|
| 31 | | - * disclaimer. |
|---|
| 32 | | - * 2. Redistributions in binary form must reproduce the above |
|---|
| 33 | | - * copyright notice, this list of conditions and the following |
|---|
| 34 | | - * disclaimer in the documentation and/or other materials |
|---|
| 35 | | - * provided with the distribution. |
|---|
| 36 | | - * |
|---|
| 37 | | - * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND |
|---|
| 38 | | - * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, |
|---|
| 39 | | - * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
|---|
| 40 | | - * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
|---|
| 41 | | - * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR |
|---|
| 42 | | - * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
|---|
| 43 | | - * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
|---|
| 44 | | - * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
|---|
| 45 | | - * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
|---|
| 46 | | - * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
|---|
| 47 | | - * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR |
|---|
| 48 | | - * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, |
|---|
| 49 | | - * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
|---|
| 5 | + * Copyright (C) 2018 embedded brains GmbH |
|---|
| 50 | 6 | */ |
|---|
| 51 | 7 | #include "libfdt_env.h" |
|---|
| 52 | 8 | |
|---|
| .. | .. |
|---|
| 55 | 11 | |
|---|
| 56 | 12 | #include "libfdt_internal.h" |
|---|
| 57 | 13 | |
|---|
| 58 | | -int fdt_address_cells(const void *fdt, int nodeoffset) |
|---|
| 14 | +static int fdt_cells(const void *fdt, int nodeoffset, const char *name) |
|---|
| 59 | 15 | { |
|---|
| 60 | | - const fdt32_t *ac; |
|---|
| 61 | | - int val; |
|---|
| 16 | + const fdt32_t *c; |
|---|
| 17 | + uint32_t val; |
|---|
| 62 | 18 | int len; |
|---|
| 63 | 19 | |
|---|
| 64 | | - ac = fdt_getprop(fdt, nodeoffset, "#address-cells", &len); |
|---|
| 65 | | - if (!ac) |
|---|
| 20 | + c = fdt_getprop(fdt, nodeoffset, name, &len); |
|---|
| 21 | + if (!c) |
|---|
| 22 | + return len; |
|---|
| 23 | + |
|---|
| 24 | + if (len != sizeof(*c)) |
|---|
| 25 | + return -FDT_ERR_BADNCELLS; |
|---|
| 26 | + |
|---|
| 27 | + val = fdt32_to_cpu(*c); |
|---|
| 28 | + if (val > FDT_MAX_NCELLS) |
|---|
| 29 | + return -FDT_ERR_BADNCELLS; |
|---|
| 30 | + |
|---|
| 31 | + return (int)val; |
|---|
| 32 | +} |
|---|
| 33 | + |
|---|
| 34 | +int fdt_address_cells(const void *fdt, int nodeoffset) |
|---|
| 35 | +{ |
|---|
| 36 | + int val; |
|---|
| 37 | + |
|---|
| 38 | + val = fdt_cells(fdt, nodeoffset, "#address-cells"); |
|---|
| 39 | + if (val == 0) |
|---|
| 40 | + return -FDT_ERR_BADNCELLS; |
|---|
| 41 | + if (val == -FDT_ERR_NOTFOUND) |
|---|
| 66 | 42 | return 2; |
|---|
| 67 | | - |
|---|
| 68 | | - if (len != sizeof(*ac)) |
|---|
| 69 | | - return -FDT_ERR_BADNCELLS; |
|---|
| 70 | | - |
|---|
| 71 | | - val = fdt32_to_cpu(*ac); |
|---|
| 72 | | - if ((val <= 0) || (val > FDT_MAX_NCELLS)) |
|---|
| 73 | | - return -FDT_ERR_BADNCELLS; |
|---|
| 74 | | - |
|---|
| 75 | 43 | return val; |
|---|
| 76 | 44 | } |
|---|
| 77 | 45 | |
|---|
| 78 | 46 | int fdt_size_cells(const void *fdt, int nodeoffset) |
|---|
| 79 | 47 | { |
|---|
| 80 | | - const fdt32_t *sc; |
|---|
| 81 | 48 | int val; |
|---|
| 82 | | - int len; |
|---|
| 83 | 49 | |
|---|
| 84 | | - sc = fdt_getprop(fdt, nodeoffset, "#size-cells", &len); |
|---|
| 85 | | - if (!sc) |
|---|
| 86 | | - return 2; |
|---|
| 87 | | - |
|---|
| 88 | | - if (len != sizeof(*sc)) |
|---|
| 89 | | - return -FDT_ERR_BADNCELLS; |
|---|
| 90 | | - |
|---|
| 91 | | - val = fdt32_to_cpu(*sc); |
|---|
| 92 | | - if ((val < 0) || (val > FDT_MAX_NCELLS)) |
|---|
| 93 | | - return -FDT_ERR_BADNCELLS; |
|---|
| 94 | | - |
|---|
| 50 | + val = fdt_cells(fdt, nodeoffset, "#size-cells"); |
|---|
| 51 | + if (val == -FDT_ERR_NOTFOUND) |
|---|
| 52 | + return 1; |
|---|
| 95 | 53 | return val; |
|---|
| 96 | 54 | } |
|---|
| 55 | + |
|---|
| 56 | +/* This function assumes that [address|size]_cells is 1 or 2 */ |
|---|
| 57 | +int fdt_appendprop_addrrange(void *fdt, int parent, int nodeoffset, |
|---|
| 58 | + const char *name, uint64_t addr, uint64_t size) |
|---|
| 59 | +{ |
|---|
| 60 | + int addr_cells, size_cells, ret; |
|---|
| 61 | + uint8_t data[sizeof(fdt64_t) * 2], *prop; |
|---|
| 62 | + |
|---|
| 63 | + ret = fdt_address_cells(fdt, parent); |
|---|
| 64 | + if (ret < 0) |
|---|
| 65 | + return ret; |
|---|
| 66 | + addr_cells = ret; |
|---|
| 67 | + |
|---|
| 68 | + ret = fdt_size_cells(fdt, parent); |
|---|
| 69 | + if (ret < 0) |
|---|
| 70 | + return ret; |
|---|
| 71 | + size_cells = ret; |
|---|
| 72 | + |
|---|
| 73 | + /* check validity of address */ |
|---|
| 74 | + prop = data; |
|---|
| 75 | + if (addr_cells == 1) { |
|---|
| 76 | + if ((addr > UINT32_MAX) || ((UINT32_MAX + 1 - addr) < size)) |
|---|
| 77 | + return -FDT_ERR_BADVALUE; |
|---|
| 78 | + |
|---|
| 79 | + fdt32_st(prop, (uint32_t)addr); |
|---|
| 80 | + } else if (addr_cells == 2) { |
|---|
| 81 | + fdt64_st(prop, addr); |
|---|
| 82 | + } else { |
|---|
| 83 | + return -FDT_ERR_BADNCELLS; |
|---|
| 84 | + } |
|---|
| 85 | + |
|---|
| 86 | + /* check validity of size */ |
|---|
| 87 | + prop += addr_cells * sizeof(fdt32_t); |
|---|
| 88 | + if (size_cells == 1) { |
|---|
| 89 | + if (size > UINT32_MAX) |
|---|
| 90 | + return -FDT_ERR_BADVALUE; |
|---|
| 91 | + |
|---|
| 92 | + fdt32_st(prop, (uint32_t)size); |
|---|
| 93 | + } else if (size_cells == 2) { |
|---|
| 94 | + fdt64_st(prop, size); |
|---|
| 95 | + } else { |
|---|
| 96 | + return -FDT_ERR_BADNCELLS; |
|---|
| 97 | + } |
|---|
| 98 | + |
|---|
| 99 | + return fdt_appendprop(fdt, nodeoffset, name, data, |
|---|
| 100 | + (addr_cells + size_cells) * sizeof(fdt32_t)); |
|---|
| 101 | +} |
|---|