]>
Commit | Line | Data |
---|---|---|
f0921f50 | 1 | // SPDX-License-Identifier: (GPL-2.0-or-later OR BSD-2-Clause) |
999a78d5 MY |
2 | /* |
3 | * libfdt - Flat Device Tree manipulation | |
4 | * Copyright (C) 2014 David Gibson <[email protected]> | |
ce2dae3a | 5 | * Copyright (C) 2018 embedded brains GmbH |
999a78d5 MY |
6 | */ |
7 | #include "libfdt_env.h" | |
8 | ||
9 | #include <fdt.h> | |
10 | #include <libfdt.h> | |
11 | ||
12 | #include "libfdt_internal.h" | |
13 | ||
ce2dae3a | 14 | static int fdt_cells(const void *fdt, int nodeoffset, const char *name) |
999a78d5 | 15 | { |
ce2dae3a | 16 | const fdt32_t *c; |
8076fc29 | 17 | uint32_t val; |
999a78d5 MY |
18 | int len; |
19 | ||
ce2dae3a MB |
20 | c = fdt_getprop(fdt, nodeoffset, name, &len); |
21 | if (!c) | |
0ba41ce1 | 22 | return len; |
999a78d5 | 23 | |
ce2dae3a | 24 | if (len != sizeof(*c)) |
999a78d5 MY |
25 | return -FDT_ERR_BADNCELLS; |
26 | ||
ce2dae3a | 27 | val = fdt32_to_cpu(*c); |
8076fc29 | 28 | if (val > FDT_MAX_NCELLS) |
999a78d5 MY |
29 | return -FDT_ERR_BADNCELLS; |
30 | ||
8076fc29 | 31 | return (int)val; |
999a78d5 MY |
32 | } |
33 | ||
ce2dae3a | 34 | int fdt_address_cells(const void *fdt, int nodeoffset) |
999a78d5 | 35 | { |
0ba41ce1 MB |
36 | int val; |
37 | ||
38 | val = fdt_cells(fdt, nodeoffset, "#address-cells"); | |
8076fc29 MB |
39 | if (val == 0) |
40 | return -FDT_ERR_BADNCELLS; | |
0ba41ce1 MB |
41 | if (val == -FDT_ERR_NOTFOUND) |
42 | return 2; | |
43 | return val; | |
ce2dae3a | 44 | } |
999a78d5 | 45 | |
ce2dae3a MB |
46 | int fdt_size_cells(const void *fdt, int nodeoffset) |
47 | { | |
0ba41ce1 MB |
48 | int val; |
49 | ||
50 | val = fdt_cells(fdt, nodeoffset, "#size-cells"); | |
51 | if (val == -FDT_ERR_NOTFOUND) | |
52 | return 1; | |
53 | return val; | |
999a78d5 | 54 | } |
f0921f50 SG |
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 | } |