fdt_subr.c revision 1.5.2.2
1 1.5.2.2 skrll /* $NetBSD: fdt_subr.c,v 1.5.2.2 2015/12/27 12:09:49 skrll Exp $ */ 2 1.5.2.2 skrll 3 1.5.2.2 skrll /*- 4 1.5.2.2 skrll * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca> 5 1.5.2.2 skrll * All rights reserved. 6 1.5.2.2 skrll * 7 1.5.2.2 skrll * Redistribution and use in source and binary forms, with or without 8 1.5.2.2 skrll * modification, are permitted provided that the following conditions 9 1.5.2.2 skrll * are met: 10 1.5.2.2 skrll * 1. Redistributions of source code must retain the above copyright 11 1.5.2.2 skrll * notice, this list of conditions and the following disclaimer. 12 1.5.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright 13 1.5.2.2 skrll * notice, this list of conditions and the following disclaimer in the 14 1.5.2.2 skrll * documentation and/or other materials provided with the distribution. 15 1.5.2.2 skrll * 16 1.5.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.5.2.2 skrll * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.5.2.2 skrll * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.5.2.2 skrll * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.5.2.2 skrll * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.5.2.2 skrll * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.5.2.2 skrll * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.5.2.2 skrll * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.5.2.2 skrll * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.5.2.2 skrll * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.5.2.2 skrll * SUCH DAMAGE. 27 1.5.2.2 skrll */ 28 1.5.2.2 skrll 29 1.5.2.2 skrll #include <sys/cdefs.h> 30 1.5.2.2 skrll __KERNEL_RCSID(0, "$NetBSD: fdt_subr.c,v 1.5.2.2 2015/12/27 12:09:49 skrll Exp $"); 31 1.5.2.2 skrll 32 1.5.2.2 skrll #include <sys/param.h> 33 1.5.2.2 skrll #include <sys/bus.h> 34 1.5.2.2 skrll #include <sys/kmem.h> 35 1.5.2.2 skrll 36 1.5.2.2 skrll #include <libfdt.h> 37 1.5.2.2 skrll #include <dev/fdt/fdtvar.h> 38 1.5.2.2 skrll 39 1.5.2.2 skrll static const void *fdt_data; 40 1.5.2.2 skrll 41 1.5.2.2 skrll bool 42 1.5.2.2 skrll fdtbus_set_data(const void *data) 43 1.5.2.2 skrll { 44 1.5.2.2 skrll KASSERT(fdt_data == NULL); 45 1.5.2.2 skrll if (fdt_check_header(data) != 0) { 46 1.5.2.2 skrll return false; 47 1.5.2.2 skrll } 48 1.5.2.2 skrll fdt_data = data; 49 1.5.2.2 skrll return true; 50 1.5.2.2 skrll } 51 1.5.2.2 skrll 52 1.5.2.2 skrll const void * 53 1.5.2.2 skrll fdtbus_get_data(void) 54 1.5.2.2 skrll { 55 1.5.2.2 skrll return fdt_data; 56 1.5.2.2 skrll } 57 1.5.2.2 skrll 58 1.5.2.2 skrll int 59 1.5.2.2 skrll fdtbus_offset2phandle(int offset) 60 1.5.2.2 skrll { 61 1.5.2.2 skrll if (offset < 0) 62 1.5.2.2 skrll return 0; 63 1.5.2.2 skrll 64 1.5.2.2 skrll return offset + fdt_off_dt_struct(fdt_data); 65 1.5.2.2 skrll } 66 1.5.2.2 skrll 67 1.5.2.2 skrll int 68 1.5.2.2 skrll fdtbus_phandle2offset(int phandle) 69 1.5.2.2 skrll { 70 1.5.2.2 skrll const int dtoff = fdt_off_dt_struct(fdt_data); 71 1.5.2.2 skrll 72 1.5.2.2 skrll if (phandle == -1) 73 1.5.2.2 skrll phandle = dtoff; 74 1.5.2.2 skrll 75 1.5.2.2 skrll if (phandle < dtoff) 76 1.5.2.2 skrll return -1; 77 1.5.2.2 skrll 78 1.5.2.2 skrll return phandle - dtoff; 79 1.5.2.2 skrll } 80 1.5.2.2 skrll 81 1.5.2.2 skrll 82 1.5.2.2 skrll static int 83 1.5.2.2 skrll fdtbus_get_addr_cells(int phandle) 84 1.5.2.2 skrll { 85 1.5.2.2 skrll uint32_t addr_cells; 86 1.5.2.2 skrll 87 1.5.2.2 skrll const int parent = OF_parent(phandle); 88 1.5.2.2 skrll if (parent == -1) 89 1.5.2.2 skrll return -1; 90 1.5.2.2 skrll 91 1.5.2.2 skrll if (of_getprop_uint32(parent, "#address-cells", &addr_cells)) 92 1.5.2.2 skrll addr_cells = 2; 93 1.5.2.2 skrll 94 1.5.2.2 skrll return addr_cells; 95 1.5.2.2 skrll } 96 1.5.2.2 skrll 97 1.5.2.2 skrll static int 98 1.5.2.2 skrll fdtbus_get_size_cells(int phandle) 99 1.5.2.2 skrll { 100 1.5.2.2 skrll uint32_t size_cells; 101 1.5.2.2 skrll 102 1.5.2.2 skrll const int parent = OF_parent(phandle); 103 1.5.2.2 skrll if (parent == -1) 104 1.5.2.2 skrll return -1; 105 1.5.2.2 skrll 106 1.5.2.2 skrll if (of_getprop_uint32(parent, "#size-cells", &size_cells)) 107 1.5.2.2 skrll size_cells = 0; 108 1.5.2.2 skrll 109 1.5.2.2 skrll return size_cells; 110 1.5.2.2 skrll } 111 1.5.2.2 skrll 112 1.5.2.2 skrll int 113 1.5.2.2 skrll fdtbus_get_phandle(int phandle, const char *prop) 114 1.5.2.2 skrll { 115 1.5.2.2 skrll u_int phandle_ref; 116 1.5.2.2 skrll u_int *buf; 117 1.5.2.2 skrll int len; 118 1.5.2.2 skrll 119 1.5.2.2 skrll len = OF_getproplen(phandle, prop); 120 1.5.2.2 skrll if (len < sizeof(phandle_ref)) 121 1.5.2.2 skrll return -1; 122 1.5.2.2 skrll 123 1.5.2.2 skrll buf = kmem_alloc(len, KM_SLEEP); 124 1.5.2.2 skrll 125 1.5.2.2 skrll if (OF_getprop(phandle, prop, buf, len) != len) { 126 1.5.2.2 skrll kmem_free(buf, len); 127 1.5.2.2 skrll return -1; 128 1.5.2.2 skrll } 129 1.5.2.2 skrll 130 1.5.2.2 skrll phandle_ref = fdt32_to_cpu(buf[0]); 131 1.5.2.2 skrll kmem_free(buf, len); 132 1.5.2.2 skrll 133 1.5.2.2 skrll return fdtbus_get_phandle_from_native(phandle_ref); 134 1.5.2.2 skrll } 135 1.5.2.2 skrll 136 1.5.2.2 skrll int 137 1.5.2.2 skrll fdtbus_get_phandle_from_native(int phandle) 138 1.5.2.2 skrll { 139 1.5.2.2 skrll const int off = fdt_node_offset_by_phandle(fdt_data, phandle); 140 1.5.2.2 skrll if (off < 0) { 141 1.5.2.2 skrll return -1; 142 1.5.2.2 skrll } 143 1.5.2.2 skrll return fdtbus_offset2phandle(off); 144 1.5.2.2 skrll } 145 1.5.2.2 skrll 146 1.5.2.2 skrll int 147 1.5.2.2 skrll fdtbus_get_reg(int phandle, u_int index, bus_addr_t *paddr, bus_size_t *psize) 148 1.5.2.2 skrll { 149 1.5.2.2 skrll bus_addr_t addr; 150 1.5.2.2 skrll bus_size_t size; 151 1.5.2.2 skrll uint8_t *buf; 152 1.5.2.2 skrll int len; 153 1.5.2.2 skrll 154 1.5.2.2 skrll const int addr_cells = fdtbus_get_addr_cells(phandle); 155 1.5.2.2 skrll const int size_cells = fdtbus_get_size_cells(phandle); 156 1.5.2.2 skrll if (addr_cells == -1 || size_cells == -1) 157 1.5.2.2 skrll return -1; 158 1.5.2.2 skrll 159 1.5.2.2 skrll const u_int reglen = size_cells * 4 + addr_cells * 4; 160 1.5.2.2 skrll if (reglen == 0) 161 1.5.2.2 skrll return -1; 162 1.5.2.2 skrll 163 1.5.2.2 skrll len = OF_getproplen(phandle, "reg"); 164 1.5.2.2 skrll if (len <= 0) 165 1.5.2.2 skrll return -1; 166 1.5.2.2 skrll 167 1.5.2.2 skrll const u_int nregs = len / reglen; 168 1.5.2.2 skrll 169 1.5.2.2 skrll if (index >= nregs) 170 1.5.2.2 skrll return -1; 171 1.5.2.2 skrll 172 1.5.2.2 skrll buf = kmem_alloc(len, KM_SLEEP); 173 1.5.2.2 skrll if (buf == NULL) 174 1.5.2.2 skrll return -1; 175 1.5.2.2 skrll 176 1.5.2.2 skrll len = OF_getprop(phandle, "reg", buf, len); 177 1.5.2.2 skrll 178 1.5.2.2 skrll switch (addr_cells) { 179 1.5.2.2 skrll case 0: 180 1.5.2.2 skrll addr = 0; 181 1.5.2.2 skrll break; 182 1.5.2.2 skrll case 1: 183 1.5.2.2 skrll addr = be32dec(&buf[index * reglen + 0]); 184 1.5.2.2 skrll break; 185 1.5.2.2 skrll case 2: 186 1.5.2.2 skrll addr = be64dec(&buf[index * reglen + 0]); 187 1.5.2.2 skrll break; 188 1.5.2.2 skrll default: 189 1.5.2.2 skrll panic("fdtbus_get_reg: unsupported addr_cells %d", addr_cells); 190 1.5.2.2 skrll } 191 1.5.2.2 skrll 192 1.5.2.2 skrll switch (size_cells) { 193 1.5.2.2 skrll case 0: 194 1.5.2.2 skrll size = 0; 195 1.5.2.2 skrll break; 196 1.5.2.2 skrll case 1: 197 1.5.2.2 skrll size = be32dec(&buf[index * reglen + addr_cells * 4]); 198 1.5.2.2 skrll break; 199 1.5.2.2 skrll case 2: 200 1.5.2.2 skrll size = be64dec(&buf[index * reglen + addr_cells * 4]); 201 1.5.2.2 skrll break; 202 1.5.2.2 skrll default: 203 1.5.2.2 skrll panic("fdtbus_get_reg: unsupported size_cells %d", size_cells); 204 1.5.2.2 skrll } 205 1.5.2.2 skrll 206 1.5.2.2 skrll if (paddr) 207 1.5.2.2 skrll *paddr = addr; 208 1.5.2.2 skrll if (psize) 209 1.5.2.2 skrll *psize = size; 210 1.5.2.2 skrll 211 1.5.2.2 skrll kmem_free(buf, len); 212 1.5.2.2 skrll 213 1.5.2.2 skrll return 0; 214 1.5.2.2 skrll } 215
Indexes created Tue Sep 30 11:09:46 GMT 2025