1*5a485aa9Sskrll /* $NetBSD: fdt_addresses.c,v 1.1.1.3 2019/12/22 12:30:37 skrll Exp $ */
2fc885a42Sskrll
3*5a485aa9Sskrll // SPDX-License-Identifier: (GPL-2.0-or-later OR BSD-2-Clause)
46233fbe7Smacallan /*
56233fbe7Smacallan * libfdt - Flat Device Tree manipulation
66233fbe7Smacallan * Copyright (C) 2014 David Gibson <david@gibson.dropbear.id.au>
7*5a485aa9Sskrll * Copyright (C) 2018 embedded brains GmbH
86233fbe7Smacallan */
96233fbe7Smacallan #include "libfdt_env.h"
106233fbe7Smacallan
116233fbe7Smacallan #include <fdt.h>
126233fbe7Smacallan #include <libfdt.h>
136233fbe7Smacallan
146233fbe7Smacallan #include "libfdt_internal.h"
156233fbe7Smacallan
fdt_cells(const void * fdt,int nodeoffset,const char * name)16*5a485aa9Sskrll static int fdt_cells(const void *fdt, int nodeoffset, const char *name)
176233fbe7Smacallan {
18*5a485aa9Sskrll const fdt32_t *c;
19*5a485aa9Sskrll uint32_t val;
206233fbe7Smacallan int len;
216233fbe7Smacallan
22*5a485aa9Sskrll c = fdt_getprop(fdt, nodeoffset, name, &len);
23*5a485aa9Sskrll if (!c)
24*5a485aa9Sskrll return len;
25*5a485aa9Sskrll
26*5a485aa9Sskrll if (len != sizeof(*c))
27*5a485aa9Sskrll return -FDT_ERR_BADNCELLS;
28*5a485aa9Sskrll
29*5a485aa9Sskrll val = fdt32_to_cpu(*c);
30*5a485aa9Sskrll if (val > FDT_MAX_NCELLS)
31*5a485aa9Sskrll return -FDT_ERR_BADNCELLS;
32*5a485aa9Sskrll
33*5a485aa9Sskrll return (int)val;
34*5a485aa9Sskrll }
35*5a485aa9Sskrll
fdt_address_cells(const void * fdt,int nodeoffset)36*5a485aa9Sskrll int fdt_address_cells(const void *fdt, int nodeoffset)
37*5a485aa9Sskrll {
38*5a485aa9Sskrll int val;
39*5a485aa9Sskrll
40*5a485aa9Sskrll val = fdt_cells(fdt, nodeoffset, "#address-cells");
41*5a485aa9Sskrll if (val == 0)
42*5a485aa9Sskrll return -FDT_ERR_BADNCELLS;
43*5a485aa9Sskrll if (val == -FDT_ERR_NOTFOUND)
446233fbe7Smacallan return 2;
456233fbe7Smacallan return val;
466233fbe7Smacallan }
476233fbe7Smacallan
fdt_size_cells(const void * fdt,int nodeoffset)486233fbe7Smacallan int fdt_size_cells(const void *fdt, int nodeoffset)
496233fbe7Smacallan {
506233fbe7Smacallan int val;
516233fbe7Smacallan
52*5a485aa9Sskrll val = fdt_cells(fdt, nodeoffset, "#size-cells");
53*5a485aa9Sskrll if (val == -FDT_ERR_NOTFOUND)
54*5a485aa9Sskrll return 1;
556233fbe7Smacallan return val;
566233fbe7Smacallan }
57*5a485aa9Sskrll
58*5a485aa9Sskrll /* This function assumes that [address|size]_cells is 1 or 2 */
fdt_appendprop_addrrange(void * fdt,int parent,int nodeoffset,const char * name,uint64_t addr,uint64_t size)59*5a485aa9Sskrll int fdt_appendprop_addrrange(void *fdt, int parent, int nodeoffset,
60*5a485aa9Sskrll const char *name, uint64_t addr, uint64_t size)
61*5a485aa9Sskrll {
62*5a485aa9Sskrll int addr_cells, size_cells, ret;
63*5a485aa9Sskrll uint8_t data[sizeof(fdt64_t) * 2], *prop;
64*5a485aa9Sskrll
65*5a485aa9Sskrll ret = fdt_address_cells(fdt, parent);
66*5a485aa9Sskrll if (ret < 0)
67*5a485aa9Sskrll return ret;
68*5a485aa9Sskrll addr_cells = ret;
69*5a485aa9Sskrll
70*5a485aa9Sskrll ret = fdt_size_cells(fdt, parent);
71*5a485aa9Sskrll if (ret < 0)
72*5a485aa9Sskrll return ret;
73*5a485aa9Sskrll size_cells = ret;
74*5a485aa9Sskrll
75*5a485aa9Sskrll /* check validity of address */
76*5a485aa9Sskrll prop = data;
77*5a485aa9Sskrll if (addr_cells == 1) {
78*5a485aa9Sskrll if ((addr > UINT32_MAX) || ((UINT32_MAX + 1 - addr) < size))
79*5a485aa9Sskrll return -FDT_ERR_BADVALUE;
80*5a485aa9Sskrll
81*5a485aa9Sskrll fdt32_st(prop, (uint32_t)addr);
82*5a485aa9Sskrll } else if (addr_cells == 2) {
83*5a485aa9Sskrll fdt64_st(prop, addr);
84*5a485aa9Sskrll } else {
85*5a485aa9Sskrll return -FDT_ERR_BADNCELLS;
86*5a485aa9Sskrll }
87*5a485aa9Sskrll
88*5a485aa9Sskrll /* check validity of size */
89*5a485aa9Sskrll prop += addr_cells * sizeof(fdt32_t);
90*5a485aa9Sskrll if (size_cells == 1) {
91*5a485aa9Sskrll if (size > UINT32_MAX)
92*5a485aa9Sskrll return -FDT_ERR_BADVALUE;
93*5a485aa9Sskrll
94*5a485aa9Sskrll fdt32_st(prop, (uint32_t)size);
95*5a485aa9Sskrll } else if (size_cells == 2) {
96*5a485aa9Sskrll fdt64_st(prop, size);
97*5a485aa9Sskrll } else {
98*5a485aa9Sskrll return -FDT_ERR_BADNCELLS;
99*5a485aa9Sskrll }
100*5a485aa9Sskrll
101*5a485aa9Sskrll return fdt_appendprop(fdt, nodeoffset, name, data,
102*5a485aa9Sskrll (addr_cells + size_cells) * sizeof(fdt32_t));
103*5a485aa9Sskrll }
104