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