fdt_openfirm.c revision 1.2.18.2
1 1.2.18.2 jdolecek /* $NetBSD: fdt_openfirm.c,v 1.2.18.2 2017/12/03 11:37:01 jdolecek Exp $ */ 2 1.2.18.2 jdolecek 3 1.2.18.2 jdolecek /*- 4 1.2.18.2 jdolecek * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca> 5 1.2.18.2 jdolecek * All rights reserved. 6 1.2.18.2 jdolecek * 7 1.2.18.2 jdolecek * Redistribution and use in source and binary forms, with or without 8 1.2.18.2 jdolecek * modification, are permitted provided that the following conditions 9 1.2.18.2 jdolecek * are met: 10 1.2.18.2 jdolecek * 1. Redistributions of source code must retain the above copyright 11 1.2.18.2 jdolecek * notice, this list of conditions and the following disclaimer. 12 1.2.18.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright 13 1.2.18.2 jdolecek * notice, this list of conditions and the following disclaimer in the 14 1.2.18.2 jdolecek * documentation and/or other materials provided with the distribution. 15 1.2.18.2 jdolecek * 16 1.2.18.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 1.2.18.2 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 1.2.18.2 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 1.2.18.2 jdolecek * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 1.2.18.2 jdolecek * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 21 1.2.18.2 jdolecek * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 22 1.2.18.2 jdolecek * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 23 1.2.18.2 jdolecek * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 24 1.2.18.2 jdolecek * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.2.18.2 jdolecek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.2.18.2 jdolecek * SUCH DAMAGE. 27 1.2.18.2 jdolecek */ 28 1.2.18.2 jdolecek 29 1.2.18.2 jdolecek #include <sys/cdefs.h> 30 1.2.18.2 jdolecek __KERNEL_RCSID(0, "$NetBSD: fdt_openfirm.c,v 1.2.18.2 2017/12/03 11:37:01 jdolecek Exp $"); 31 1.2.18.2 jdolecek 32 1.2.18.2 jdolecek #include <sys/param.h> 33 1.2.18.2 jdolecek 34 1.2.18.2 jdolecek #include <libfdt.h> 35 1.2.18.2 jdolecek #include <dev/fdt/fdtvar.h> 36 1.2.18.2 jdolecek 37 1.2.18.2 jdolecek int 38 1.2.18.2 jdolecek OF_peer(int phandle) 39 1.2.18.2 jdolecek { 40 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 41 1.2.18.2 jdolecek int off, depth; 42 1.2.18.2 jdolecek 43 1.2.18.2 jdolecek if (fdt_data == NULL) { 44 1.2.18.2 jdolecek return -1; 45 1.2.18.2 jdolecek } 46 1.2.18.2 jdolecek 47 1.2.18.2 jdolecek if (phandle == 0) { 48 1.2.18.2 jdolecek return fdtbus_offset2phandle(0); 49 1.2.18.2 jdolecek } 50 1.2.18.2 jdolecek 51 1.2.18.2 jdolecek off = fdtbus_phandle2offset(phandle); 52 1.2.18.2 jdolecek if (off < 0) { 53 1.2.18.2 jdolecek return 0; 54 1.2.18.2 jdolecek } 55 1.2.18.2 jdolecek 56 1.2.18.2 jdolecek depth = 1; 57 1.2.18.2 jdolecek for (off = fdt_next_node(fdt_data, off, &depth); 58 1.2.18.2 jdolecek off >= 0 && depth >= 0; 59 1.2.18.2 jdolecek off = fdt_next_node(fdt_data, off, &depth)) { 60 1.2.18.2 jdolecek if (depth == 1) { 61 1.2.18.2 jdolecek return fdtbus_offset2phandle(off); 62 1.2.18.2 jdolecek } 63 1.2.18.2 jdolecek } 64 1.2.18.2 jdolecek 65 1.2.18.2 jdolecek return 0; 66 1.2.18.2 jdolecek } 67 1.2.18.2 jdolecek 68 1.2.18.2 jdolecek int 69 1.2.18.2 jdolecek OF_child(int phandle) 70 1.2.18.2 jdolecek { 71 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 72 1.2.18.2 jdolecek int off, depth; 73 1.2.18.2 jdolecek 74 1.2.18.2 jdolecek if (fdt_data == NULL) { 75 1.2.18.2 jdolecek return -1; 76 1.2.18.2 jdolecek } 77 1.2.18.2 jdolecek 78 1.2.18.2 jdolecek off = fdtbus_phandle2offset(phandle); 79 1.2.18.2 jdolecek if (off < 0) { 80 1.2.18.2 jdolecek return 0; 81 1.2.18.2 jdolecek } 82 1.2.18.2 jdolecek 83 1.2.18.2 jdolecek depth = 0; 84 1.2.18.2 jdolecek for (off = fdt_next_node(fdt_data, off, &depth); 85 1.2.18.2 jdolecek off >= 0 && depth > 0; 86 1.2.18.2 jdolecek off = fdt_next_node(fdt_data, off, &depth)) { 87 1.2.18.2 jdolecek if (depth == 1) { 88 1.2.18.2 jdolecek return fdtbus_offset2phandle(off); 89 1.2.18.2 jdolecek } 90 1.2.18.2 jdolecek } 91 1.2.18.2 jdolecek 92 1.2.18.2 jdolecek return 0; 93 1.2.18.2 jdolecek } 94 1.2.18.2 jdolecek 95 1.2.18.2 jdolecek int 96 1.2.18.2 jdolecek OF_parent(int phandle) 97 1.2.18.2 jdolecek { 98 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 99 1.2.18.2 jdolecek int off; 100 1.2.18.2 jdolecek 101 1.2.18.2 jdolecek if (fdt_data == NULL) { 102 1.2.18.2 jdolecek return -1; 103 1.2.18.2 jdolecek } 104 1.2.18.2 jdolecek 105 1.2.18.2 jdolecek off = fdtbus_phandle2offset(phandle); 106 1.2.18.2 jdolecek if (off < 0) { 107 1.2.18.2 jdolecek return -1; 108 1.2.18.2 jdolecek } 109 1.2.18.2 jdolecek 110 1.2.18.2 jdolecek off = fdt_parent_offset(fdt_data, off); 111 1.2.18.2 jdolecek if (off < 0) { 112 1.2.18.2 jdolecek return -1; 113 1.2.18.2 jdolecek } 114 1.2.18.2 jdolecek 115 1.2.18.2 jdolecek return fdtbus_offset2phandle(off); 116 1.2.18.2 jdolecek } 117 1.2.18.2 jdolecek 118 1.2.18.2 jdolecek int 119 1.2.18.2 jdolecek OF_nextprop(int phandle, const char *prop, void *nextprop) 120 1.2.18.2 jdolecek { 121 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 122 1.2.18.2 jdolecek const char *name; 123 1.2.18.2 jdolecek const void *val; 124 1.2.18.2 jdolecek int off, len; 125 1.2.18.2 jdolecek 126 1.2.18.2 jdolecek if (fdt_data == NULL) { 127 1.2.18.2 jdolecek return -1; 128 1.2.18.2 jdolecek } 129 1.2.18.2 jdolecek 130 1.2.18.2 jdolecek off = fdtbus_phandle2offset(phandle); 131 1.2.18.2 jdolecek if (off < 0) { 132 1.2.18.2 jdolecek return -1; 133 1.2.18.2 jdolecek } 134 1.2.18.2 jdolecek 135 1.2.18.2 jdolecek if (*prop == '\0') { 136 1.2.18.2 jdolecek name = "name"; 137 1.2.18.2 jdolecek } else { 138 1.2.18.2 jdolecek off = fdt_first_property_offset(fdt_data, off); 139 1.2.18.2 jdolecek if (off < 0) { 140 1.2.18.2 jdolecek return 0; 141 1.2.18.2 jdolecek } 142 1.2.18.2 jdolecek if (strcmp(prop, "name") != 0) { 143 1.2.18.2 jdolecek while (off >= 0) { 144 1.2.18.2 jdolecek val = fdt_getprop_by_offset(fdt_data, off, 145 1.2.18.2 jdolecek &name, &len); 146 1.2.18.2 jdolecek if (val == NULL) { 147 1.2.18.2 jdolecek return -1; 148 1.2.18.2 jdolecek } 149 1.2.18.2 jdolecek off = fdt_next_property_offset(fdt_data, off); 150 1.2.18.2 jdolecek if (off < 0) { 151 1.2.18.2 jdolecek return 0; 152 1.2.18.2 jdolecek } 153 1.2.18.2 jdolecek if (strcmp(name, prop) == 0) 154 1.2.18.2 jdolecek break; 155 1.2.18.2 jdolecek } 156 1.2.18.2 jdolecek } 157 1.2.18.2 jdolecek val = fdt_getprop_by_offset(fdt_data, off, &name, &len); 158 1.2.18.2 jdolecek if (val == NULL) { 159 1.2.18.2 jdolecek return -1; 160 1.2.18.2 jdolecek } 161 1.2.18.2 jdolecek } 162 1.2.18.2 jdolecek 163 1.2.18.2 jdolecek strlcpy(nextprop, name, 33); 164 1.2.18.2 jdolecek 165 1.2.18.2 jdolecek return 1; 166 1.2.18.2 jdolecek } 167 1.2.18.2 jdolecek 168 1.2.18.2 jdolecek int 169 1.2.18.2 jdolecek OF_getprop(int phandle, const char *prop, void *buf, int buflen) 170 1.2.18.2 jdolecek { 171 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 172 1.2.18.2 jdolecek const char *name; 173 1.2.18.2 jdolecek const void *val; 174 1.2.18.2 jdolecek int off, len; 175 1.2.18.2 jdolecek 176 1.2.18.2 jdolecek if (fdt_data == NULL) { 177 1.2.18.2 jdolecek return -1; 178 1.2.18.2 jdolecek } 179 1.2.18.2 jdolecek 180 1.2.18.2 jdolecek off = fdtbus_phandle2offset(phandle); 181 1.2.18.2 jdolecek if (off < 0) { 182 1.2.18.2 jdolecek return -1; 183 1.2.18.2 jdolecek } 184 1.2.18.2 jdolecek 185 1.2.18.2 jdolecek if (strcmp(prop, "name") == 0) { 186 1.2.18.2 jdolecek val = fdt_get_name(fdt_data, off, &len); 187 1.2.18.2 jdolecek if (val) { 188 1.2.18.2 jdolecek const char *p = strchr(val, '@'); 189 1.2.18.2 jdolecek if (p) { 190 1.2.18.2 jdolecek len = (uintptr_t)p - (uintptr_t)val + 1; 191 1.2.18.2 jdolecek } else { 192 1.2.18.2 jdolecek len += 1; 193 1.2.18.2 jdolecek } 194 1.2.18.2 jdolecek } 195 1.2.18.2 jdolecek if (val == NULL || len > buflen) { 196 1.2.18.2 jdolecek return -1; 197 1.2.18.2 jdolecek } 198 1.2.18.2 jdolecek char *s = buf; 199 1.2.18.2 jdolecek memcpy(buf, val, len - 1); 200 1.2.18.2 jdolecek s[len - 1] = '\0'; 201 1.2.18.2 jdolecek } else { 202 1.2.18.2 jdolecek off = fdt_first_property_offset(fdt_data, off); 203 1.2.18.2 jdolecek if (off < 0) { 204 1.2.18.2 jdolecek return -1; 205 1.2.18.2 jdolecek } 206 1.2.18.2 jdolecek while (off >= 0) { 207 1.2.18.2 jdolecek val = fdt_getprop_by_offset(fdt_data, off, &name, &len); 208 1.2.18.2 jdolecek if (val == NULL) { 209 1.2.18.2 jdolecek return -1; 210 1.2.18.2 jdolecek } 211 1.2.18.2 jdolecek if (strcmp(name, prop) == 0) { 212 1.2.18.2 jdolecek break; 213 1.2.18.2 jdolecek } 214 1.2.18.2 jdolecek off = fdt_next_property_offset(fdt_data, off); 215 1.2.18.2 jdolecek if (off < 0) { 216 1.2.18.2 jdolecek return -1; 217 1.2.18.2 jdolecek } 218 1.2.18.2 jdolecek } 219 1.2.18.2 jdolecek if (val == NULL || len > buflen) { 220 1.2.18.2 jdolecek return -1; 221 1.2.18.2 jdolecek } 222 1.2.18.2 jdolecek memcpy(buf, val, len); 223 1.2.18.2 jdolecek } 224 1.2.18.2 jdolecek 225 1.2.18.2 jdolecek return len; 226 1.2.18.2 jdolecek } 227 1.2.18.2 jdolecek 228 1.2.18.2 jdolecek int 229 1.2.18.2 jdolecek OF_getproplen(int phandle, const char *prop) 230 1.2.18.2 jdolecek { 231 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 232 1.2.18.2 jdolecek const char *name; 233 1.2.18.2 jdolecek const void *val; 234 1.2.18.2 jdolecek int off, len; 235 1.2.18.2 jdolecek 236 1.2.18.2 jdolecek if (fdt_data == NULL) { 237 1.2.18.2 jdolecek return -1; 238 1.2.18.2 jdolecek } 239 1.2.18.2 jdolecek 240 1.2.18.2 jdolecek off = fdtbus_phandle2offset(phandle); 241 1.2.18.2 jdolecek if (off < 0) { 242 1.2.18.2 jdolecek return -1; 243 1.2.18.2 jdolecek } 244 1.2.18.2 jdolecek 245 1.2.18.2 jdolecek if (strcmp(prop, "name") == 0) { 246 1.2.18.2 jdolecek val = fdt_get_name(fdt_data, off, &len); 247 1.2.18.2 jdolecek if (val) { 248 1.2.18.2 jdolecek const char *p = strchr(val, '@'); 249 1.2.18.2 jdolecek if (p) { 250 1.2.18.2 jdolecek len = (uintptr_t)p - (uintptr_t)val + 1; 251 1.2.18.2 jdolecek } else { 252 1.2.18.2 jdolecek len += 1; 253 1.2.18.2 jdolecek } 254 1.2.18.2 jdolecek } 255 1.2.18.2 jdolecek } else { 256 1.2.18.2 jdolecek off = fdt_first_property_offset(fdt_data, off); 257 1.2.18.2 jdolecek if (off < 0) { 258 1.2.18.2 jdolecek return -1; 259 1.2.18.2 jdolecek } 260 1.2.18.2 jdolecek while (off >= 0) { 261 1.2.18.2 jdolecek val = fdt_getprop_by_offset(fdt_data, off, &name, &len); 262 1.2.18.2 jdolecek if (val == NULL) { 263 1.2.18.2 jdolecek return -1; 264 1.2.18.2 jdolecek } 265 1.2.18.2 jdolecek if (strcmp(name, prop) == 0) { 266 1.2.18.2 jdolecek break; 267 1.2.18.2 jdolecek } 268 1.2.18.2 jdolecek off = fdt_next_property_offset(fdt_data, off); 269 1.2.18.2 jdolecek if (off < 0) { 270 1.2.18.2 jdolecek return -1; 271 1.2.18.2 jdolecek } 272 1.2.18.2 jdolecek } 273 1.2.18.2 jdolecek } 274 1.2.18.2 jdolecek if (val == NULL) { 275 1.2.18.2 jdolecek return -1; 276 1.2.18.2 jdolecek } 277 1.2.18.2 jdolecek 278 1.2.18.2 jdolecek return len; 279 1.2.18.2 jdolecek } 280 1.2.18.2 jdolecek 281 1.2.18.2 jdolecek int 282 1.2.18.2 jdolecek OF_setprop(int phandle, const char *prop, const void *buf, int buflen) 283 1.2.18.2 jdolecek { 284 1.2.18.2 jdolecek return -1; 285 1.2.18.2 jdolecek } 286 1.2.18.2 jdolecek 287 1.2.18.2 jdolecek int 288 1.2.18.2 jdolecek OF_finddevice(const char *name) 289 1.2.18.2 jdolecek { 290 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 291 1.2.18.2 jdolecek int off; 292 1.2.18.2 jdolecek 293 1.2.18.2 jdolecek if (fdt_data == NULL) { 294 1.2.18.2 jdolecek return -1; 295 1.2.18.2 jdolecek } 296 1.2.18.2 jdolecek 297 1.2.18.2 jdolecek off = fdt_path_offset(fdt_data, name); 298 1.2.18.2 jdolecek if (off < 0) { 299 1.2.18.2 jdolecek return -1; 300 1.2.18.2 jdolecek } 301 1.2.18.2 jdolecek 302 1.2.18.2 jdolecek return fdtbus_offset2phandle(off); 303 1.2.18.2 jdolecek } 304 1.2.18.2 jdolecek 305 1.2.18.2 jdolecek int 306 1.2.18.2 jdolecek OF_package_to_path(int phandle, char *buf, int buflen) 307 1.2.18.2 jdolecek { 308 1.2.18.2 jdolecek const void *fdt_data = fdtbus_get_data(); 309 1.2.18.2 jdolecek int off; 310 1.2.18.2 jdolecek 311 1.2.18.2 jdolecek if (fdt_data == NULL) { 312 1.2.18.2 jdolecek return -1; 313 1.2.18.2 jdolecek } 314 1.2.18.2 jdolecek 315 1.2.18.2 jdolecek off = fdtbus_phandle2offset(phandle); 316 1.2.18.2 jdolecek if (off < 0) { 317 1.2.18.2 jdolecek return -1; 318 1.2.18.2 jdolecek } 319 1.2.18.2 jdolecek 320 1.2.18.2 jdolecek if (fdt_get_path(fdt_data, off, buf, buflen) != 0) 321 1.2.18.2 jdolecek return -1; 322 1.2.18.2 jdolecek 323 1.2.18.2 jdolecek return strlen(buf); 324 1.2.18.2 jdolecek } 325
Indexes created Fri Oct 03 02:09:57 GMT 2025