ofw_fdt.c revision 277289
1208615Sraj/*- 2208615Sraj * Copyright (c) 2009-2010 The FreeBSD Foundation 3208615Sraj * All rights reserved. 4208615Sraj * 5208615Sraj * This software was developed by Semihalf under sponsorship from 6208615Sraj * the FreeBSD Foundation. 7208615Sraj * 8208615Sraj * Redistribution and use in source and binary forms, with or without 9208615Sraj * modification, are permitted provided that the following conditions 10208615Sraj * are met: 11208615Sraj * 1. Redistributions of source code must retain the above copyright 12208615Sraj * notice, this list of conditions and the following disclaimer. 13208615Sraj * 2. Redistributions in binary form must reproduce the above copyright 14208615Sraj * notice, this list of conditions and the following disclaimer in the 15208615Sraj * documentation and/or other materials provided with the distribution. 16208615Sraj * 17208615Sraj * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 18208615Sraj * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19208615Sraj * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20208615Sraj * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21208615Sraj * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22208615Sraj * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23208615Sraj * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24208615Sraj * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25208615Sraj * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26208615Sraj * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27208615Sraj * SUCH DAMAGE. 28208615Sraj */ 29208615Sraj 30208615Sraj#include <sys/cdefs.h> 31208615Sraj__FBSDID("$FreeBSD: head/sys/dev/ofw/ofw_fdt.c 277289 2015-01-17 07:01:51Z nwhitehorn $"); 32208615Sraj 33208615Sraj#include <sys/param.h> 34208615Sraj#include <sys/kernel.h> 35208615Sraj#include <sys/malloc.h> 36208615Sraj#include <sys/systm.h> 37208615Sraj 38208615Sraj#include <contrib/libfdt/libfdt.h> 39208615Sraj 40208615Sraj#include <machine/stdarg.h> 41208615Sraj 42208615Sraj#include <dev/fdt/fdt_common.h> 43208615Sraj#include <dev/ofw/ofwvar.h> 44208615Sraj#include <dev/ofw/openfirm.h> 45208615Sraj 46208615Sraj#include "ofw_if.h" 47208615Sraj 48208615Sraj#ifdef DEBUG 49208615Sraj#define debugf(fmt, args...) do { printf("%s(): ", __func__); \ 50208615Sraj printf(fmt,##args); } while (0) 51208615Sraj#else 52208615Sraj#define debugf(fmt, args...) 53208615Sraj#endif 54208615Sraj 55208615Srajstatic int ofw_fdt_init(ofw_t, void *); 56208615Srajstatic phandle_t ofw_fdt_peer(ofw_t, phandle_t); 57208615Srajstatic phandle_t ofw_fdt_child(ofw_t, phandle_t); 58208615Srajstatic phandle_t ofw_fdt_parent(ofw_t, phandle_t); 59208615Srajstatic phandle_t ofw_fdt_instance_to_package(ofw_t, ihandle_t); 60208615Srajstatic ssize_t ofw_fdt_getproplen(ofw_t, phandle_t, const char *); 61208615Srajstatic ssize_t ofw_fdt_getprop(ofw_t, phandle_t, const char *, void *, size_t); 62208615Srajstatic int ofw_fdt_nextprop(ofw_t, phandle_t, const char *, char *, size_t); 63208615Srajstatic int ofw_fdt_setprop(ofw_t, phandle_t, const char *, const void *, 64208615Sraj size_t); 65208615Srajstatic ssize_t ofw_fdt_canon(ofw_t, const char *, char *, size_t); 66208615Srajstatic phandle_t ofw_fdt_finddevice(ofw_t, const char *); 67208615Srajstatic ssize_t ofw_fdt_instance_to_path(ofw_t, ihandle_t, char *, size_t); 68208615Srajstatic ssize_t ofw_fdt_package_to_path(ofw_t, phandle_t, char *, size_t); 69212477Smariusstatic int ofw_fdt_interpret(ofw_t, const char *, int, cell_t *); 70208615Sraj 71208615Srajstatic ofw_method_t ofw_fdt_methods[] = { 72208615Sraj OFWMETHOD(ofw_init, ofw_fdt_init), 73208615Sraj OFWMETHOD(ofw_peer, ofw_fdt_peer), 74208615Sraj OFWMETHOD(ofw_child, ofw_fdt_child), 75208615Sraj OFWMETHOD(ofw_parent, ofw_fdt_parent), 76208615Sraj OFWMETHOD(ofw_instance_to_package, ofw_fdt_instance_to_package), 77208615Sraj OFWMETHOD(ofw_getproplen, ofw_fdt_getproplen), 78208615Sraj OFWMETHOD(ofw_getprop, ofw_fdt_getprop), 79208615Sraj OFWMETHOD(ofw_nextprop, ofw_fdt_nextprop), 80208615Sraj OFWMETHOD(ofw_setprop, ofw_fdt_setprop), 81208615Sraj OFWMETHOD(ofw_canon, ofw_fdt_canon), 82208615Sraj OFWMETHOD(ofw_finddevice, ofw_fdt_finddevice), 83208615Sraj OFWMETHOD(ofw_instance_to_path, ofw_fdt_instance_to_path), 84208615Sraj OFWMETHOD(ofw_package_to_path, ofw_fdt_package_to_path), 85208615Sraj OFWMETHOD(ofw_interpret, ofw_fdt_interpret), 86208615Sraj { 0, 0 } 87208615Sraj}; 88208615Sraj 89208615Srajstatic ofw_def_t ofw_fdt = { 90208615Sraj OFW_FDT, 91208615Sraj ofw_fdt_methods, 92208615Sraj 0 93208615Sraj}; 94208615SrajOFW_DEF(ofw_fdt); 95208615Sraj 96208615Srajstatic void *fdtp = NULL; 97208615Sraj 98208615Srajstatic int 99208615Srajofw_fdt_init(ofw_t ofw, void *data) 100208615Sraj{ 101208615Sraj int err; 102208615Sraj 103208615Sraj /* Check FDT blob integrity */ 104208615Sraj if ((err = fdt_check_header(data)) != 0) 105208615Sraj return (err); 106208615Sraj 107208615Sraj fdtp = data; 108208615Sraj return (0); 109208615Sraj} 110208615Sraj 111208615Sraj/* 112226466Sjchandra * Device tree functions. 113226466Sjchandra * 114226466Sjchandra * We use the offset from fdtp to the node as the 'phandle' in OF interface. 115226466Sjchandra * 116226466Sjchandra * phandle is a u32 value, therefore we cannot use the pointer to node as 117226466Sjchandra * phandle in 64 bit. We also do not use the usual fdt offset as phandle, 118226466Sjchandra * as it can be 0, and the OF interface has special meaning for phandle 0. 119208615Sraj */ 120208615Sraj 121226466Sjchandrastatic phandle_t 122226466Sjchandrafdt_offset_phandle(int offset) 123226466Sjchandra{ 124226466Sjchandra if (offset < 0) 125226466Sjchandra return (0); 126226466Sjchandra return ((phandle_t)offset + fdt_off_dt_struct(fdtp)); 127226466Sjchandra} 128226466Sjchandra 129208615Srajstatic int 130208615Srajfdt_phandle_offset(phandle_t p) 131208615Sraj{ 132226466Sjchandra int pint = (int)p; 133226466Sjchandra int dtoff = fdt_off_dt_struct(fdtp); 134226466Sjchandra 135226466Sjchandra if (pint < dtoff) 136226466Sjchandra return (-1); 137226466Sjchandra return (pint - dtoff); 138226466Sjchandra} 139226466Sjchandra 140208615Sraj/* Return the next sibling of this node or 0. */ 141208615Srajstatic phandle_t 142208615Srajofw_fdt_peer(ofw_t ofw, phandle_t node) 143208615Sraj{ 144208615Sraj int depth, offset; 145208615Sraj 146208615Sraj if (node == 0) { 147208615Sraj /* Find root node */ 148208615Sraj offset = fdt_path_offset(fdtp, "/"); 149208615Sraj 150226466Sjchandra return (fdt_offset_phandle(offset)); 151208615Sraj } 152208615Sraj 153208615Sraj offset = fdt_phandle_offset(node); 154208615Sraj if (offset < 0) 155208615Sraj return (0); 156208615Sraj 157208615Sraj for (depth = 1, offset = fdt_next_node(fdtp, offset, &depth); 158208615Sraj offset >= 0; 159208615Sraj offset = fdt_next_node(fdtp, offset, &depth)) { 160208615Sraj if (depth < 0) 161208615Sraj return (0); 162226466Sjchandra if (depth == 1) 163226466Sjchandra return (fdt_offset_phandle(offset)); 164208615Sraj } 165208615Sraj 166208615Sraj return (0); 167208615Sraj} 168208615Sraj 169208615Sraj/* Return the first child of this node or 0. */ 170208615Srajstatic phandle_t 171208615Srajofw_fdt_child(ofw_t ofw, phandle_t node) 172208615Sraj{ 173208615Sraj int depth, offset; 174208615Sraj 175208615Sraj offset = fdt_phandle_offset(node); 176208615Sraj if (offset < 0) 177208615Sraj return (0); 178208615Sraj 179208615Sraj for (depth = 0, offset = fdt_next_node(fdtp, offset, &depth); 180208615Sraj (offset >= 0) && (depth > 0); 181208615Sraj offset = fdt_next_node(fdtp, offset, &depth)) { 182208615Sraj if (depth < 0) 183208615Sraj return (0); 184226466Sjchandra if (depth == 1) 185226466Sjchandra return (fdt_offset_phandle(offset)); 186208615Sraj } 187208615Sraj 188208615Sraj return (0); 189208615Sraj} 190208615Sraj 191208615Sraj/* Return the parent of this node or 0. */ 192208615Srajstatic phandle_t 193208615Srajofw_fdt_parent(ofw_t ofw, phandle_t node) 194208615Sraj{ 195208615Sraj int offset, paroffset; 196208615Sraj 197208615Sraj offset = fdt_phandle_offset(node); 198208615Sraj if (offset < 0) 199208615Sraj return (0); 200208615Sraj 201208615Sraj paroffset = fdt_parent_offset(fdtp, offset); 202226466Sjchandra return (fdt_offset_phandle(paroffset)); 203208615Sraj} 204208615Sraj 205208615Sraj/* Return the package handle that corresponds to an instance handle. */ 206208615Srajstatic phandle_t 207208615Srajofw_fdt_instance_to_package(ofw_t ofw, ihandle_t instance) 208208615Sraj{ 209208615Sraj 210258805Snwhitehorn /* Where real OF uses ihandles in the tree, FDT uses xref phandles */ 211270945Sian return (OF_node_from_xref(instance)); 212208615Sraj} 213208615Sraj 214208615Sraj/* Get the length of a property of a package. */ 215208615Srajstatic ssize_t 216208615Srajofw_fdt_getproplen(ofw_t ofw, phandle_t package, const char *propname) 217208615Sraj{ 218208615Sraj const struct fdt_property *prop; 219208615Sraj int offset, len; 220208615Sraj 221208615Sraj offset = fdt_phandle_offset(package); 222208615Sraj if (offset < 0) 223215120Sraj return (-1); 224208615Sraj 225276514Snwhitehorn len = -1; 226276514Snwhitehorn prop = fdt_get_property(fdtp, offset, propname, &len); 227276514Snwhitehorn 228276514Snwhitehorn if (prop == NULL && strcmp(propname, "name") == 0) { 229208615Sraj /* Emulate the 'name' property */ 230208615Sraj fdt_get_name(fdtp, offset, &len); 231208615Sraj return (len + 1); 232208615Sraj } 233208615Sraj 234277257Snwhitehorn if (prop == NULL && offset == fdt_path_offset(fdtp, "/chosen")) { 235277257Snwhitehorn if (strcmp(propname, "fdtbootcpu") == 0) 236277257Snwhitehorn return (sizeof(cell_t)); 237277257Snwhitehorn if (strcmp(propname, "fdtmemreserv") == 0) 238277257Snwhitehorn return (sizeof(uint64_t)*2*fdt_num_mem_rsv(fdtp)); 239277257Snwhitehorn } 240277257Snwhitehorn 241277289Snwhitehorn if (prop == NULL) 242277289Snwhitehorn return (-1); 243277289Snwhitehorn 244208615Sraj return (len); 245208615Sraj} 246208615Sraj 247208615Sraj/* Get the value of a property of a package. */ 248208615Srajstatic ssize_t 249208615Srajofw_fdt_getprop(ofw_t ofw, phandle_t package, const char *propname, void *buf, 250208615Sraj size_t buflen) 251208615Sraj{ 252208615Sraj const void *prop; 253208615Sraj const char *name; 254208615Sraj int len, offset; 255277257Snwhitehorn uint32_t cpuid; 256208615Sraj 257208615Sraj offset = fdt_phandle_offset(package); 258208615Sraj if (offset < 0) 259215120Sraj return (-1); 260208615Sraj 261276514Snwhitehorn prop = fdt_getprop(fdtp, offset, propname, &len); 262276514Snwhitehorn 263276514Snwhitehorn if (prop == NULL && strcmp(propname, "name") == 0) { 264208615Sraj /* Emulate the 'name' property */ 265208615Sraj name = fdt_get_name(fdtp, offset, &len); 266208615Sraj strncpy(buf, name, buflen); 267208615Sraj if (len + 1 > buflen) 268208615Sraj len = buflen; 269208615Sraj return (len + 1); 270208615Sraj } 271208615Sraj 272277257Snwhitehorn if (prop == NULL && offset == fdt_path_offset(fdtp, "/chosen")) { 273277257Snwhitehorn if (strcmp(propname, "fdtbootcpu") == 0) { 274277257Snwhitehorn cpuid = cpu_to_fdt32(fdt_boot_cpuid_phys(fdtp)); 275277257Snwhitehorn len = sizeof(cpuid); 276277257Snwhitehorn prop = &cpuid; 277277257Snwhitehorn } 278277257Snwhitehorn if (strcmp(propname, "fdtmemreserv") == 0) { 279277257Snwhitehorn prop = (char *)fdtp + fdt_off_mem_rsvmap(fdtp); 280277257Snwhitehorn len = sizeof(uint64_t)*2*fdt_num_mem_rsv(fdtp); 281277257Snwhitehorn } 282277257Snwhitehorn } 283277257Snwhitehorn 284208615Sraj if (prop == NULL) 285215120Sraj return (-1); 286208615Sraj 287208615Sraj if (len > buflen) 288208615Sraj len = buflen; 289208615Sraj bcopy(prop, buf, len); 290208615Sraj return (len); 291208615Sraj} 292208615Sraj 293208615Sraj/* 294259199Snwhitehorn * Get the next property of a package. Return values: 295259199Snwhitehorn * -1: package or previous property does not exist 296259199Snwhitehorn * 0: no more properties 297259199Snwhitehorn * 1: success 298208615Sraj */ 299208615Srajstatic int 300208615Srajofw_fdt_nextprop(ofw_t ofw, phandle_t package, const char *previous, char *buf, 301208615Sraj size_t size) 302208615Sraj{ 303208615Sraj const struct fdt_property *prop; 304257745Snwhitehorn const char *name; 305257745Snwhitehorn int offset; 306208615Sraj 307208615Sraj offset = fdt_phandle_offset(package); 308208615Sraj if (offset < 0) 309215120Sraj return (-1); 310208615Sraj 311257745Snwhitehorn /* Find the first prop in the node */ 312257745Snwhitehorn offset = fdt_first_property_offset(fdtp, offset); 313257747Snwhitehorn if (offset < 0) 314257747Snwhitehorn return (0); /* No properties */ 315208615Sraj 316257745Snwhitehorn if (previous != NULL) { 317257745Snwhitehorn while (offset >= 0) { 318257745Snwhitehorn prop = fdt_get_property_by_offset(fdtp, offset, NULL); 319257745Snwhitehorn if (prop == NULL) 320257745Snwhitehorn return (-1); /* Internal error */ 321257745Snwhitehorn 322257745Snwhitehorn offset = fdt_next_property_offset(fdtp, offset); 323257745Snwhitehorn if (offset < 0) 324257745Snwhitehorn return (0); /* No more properties */ 325257745Snwhitehorn 326257745Snwhitehorn /* Check if the last one was the one we wanted */ 327257745Snwhitehorn name = fdt_string(fdtp, fdt32_to_cpu(prop->nameoff)); 328257745Snwhitehorn if (strcmp(name, previous) == 0) 329257745Snwhitehorn break; 330257745Snwhitehorn } 331257745Snwhitehorn } 332257745Snwhitehorn 333257745Snwhitehorn prop = fdt_get_property_by_offset(fdtp, offset, &offset); 334208615Sraj if (prop == NULL) 335257745Snwhitehorn return (-1); /* Internal error */ 336208615Sraj 337257745Snwhitehorn strncpy(buf, fdt_string(fdtp, fdt32_to_cpu(prop->nameoff)), size); 338257745Snwhitehorn 339259199Snwhitehorn return (1); 340208615Sraj} 341208615Sraj 342208615Sraj/* Set the value of a property of a package. */ 343208615Srajstatic int 344208615Srajofw_fdt_setprop(ofw_t ofw, phandle_t package, const char *propname, 345208615Sraj const void *buf, size_t len) 346208615Sraj{ 347208615Sraj int offset; 348208615Sraj 349208615Sraj offset = fdt_phandle_offset(package); 350208615Sraj if (offset < 0) 351208615Sraj return (-1); 352208615Sraj 353208615Sraj return (fdt_setprop_inplace(fdtp, offset, propname, buf, len)); 354208615Sraj} 355208615Sraj 356208615Sraj/* Convert a device specifier to a fully qualified pathname. */ 357208615Srajstatic ssize_t 358208615Srajofw_fdt_canon(ofw_t ofw, const char *device, char *buf, size_t len) 359208615Sraj{ 360208615Sraj 361208615Sraj return (-1); 362208615Sraj} 363208615Sraj 364208615Sraj/* Return a package handle for the specified device. */ 365208615Srajstatic phandle_t 366208615Srajofw_fdt_finddevice(ofw_t ofw, const char *device) 367208615Sraj{ 368208615Sraj int offset; 369208615Sraj 370208615Sraj offset = fdt_path_offset(fdtp, device); 371228201Sjchandra if (offset < 0) 372228201Sjchandra return (-1); 373226466Sjchandra return (fdt_offset_phandle(offset)); 374208615Sraj} 375208615Sraj 376208615Sraj/* Return the fully qualified pathname corresponding to an instance. */ 377208615Srajstatic ssize_t 378208615Srajofw_fdt_instance_to_path(ofw_t ofw, ihandle_t instance, char *buf, size_t len) 379208615Sraj{ 380258805Snwhitehorn phandle_t phandle; 381208615Sraj 382258805Snwhitehorn phandle = OF_instance_to_package(instance); 383258805Snwhitehorn if (phandle == -1) 384258805Snwhitehorn return (-1); 385258805Snwhitehorn 386258805Snwhitehorn return (OF_package_to_path(phandle, buf, len)); 387208615Sraj} 388208615Sraj 389208615Sraj/* Return the fully qualified pathname corresponding to a package. */ 390208615Srajstatic ssize_t 391208615Srajofw_fdt_package_to_path(ofw_t ofw, phandle_t package, char *buf, size_t len) 392208615Sraj{ 393208615Sraj 394208615Sraj return (-1); 395208615Sraj} 396208615Sraj 397208615Srajstatic int 398208615Srajofw_fdt_fixup(ofw_t ofw) 399208615Sraj{ 400208615Sraj#define FDT_MODEL_LEN 80 401208615Sraj char model[FDT_MODEL_LEN]; 402208615Sraj phandle_t root; 403208615Sraj ssize_t len; 404208615Sraj int i; 405208615Sraj 406228201Sjchandra if ((root = ofw_fdt_finddevice(ofw, "/")) == -1) 407208615Sraj return (ENODEV); 408208615Sraj 409208615Sraj if ((len = ofw_fdt_getproplen(ofw, root, "model")) <= 0) 410208615Sraj return (0); 411208615Sraj 412208615Sraj bzero(model, FDT_MODEL_LEN); 413208615Sraj if (ofw_fdt_getprop(ofw, root, "model", model, FDT_MODEL_LEN) <= 0) 414208615Sraj return (0); 415208615Sraj 416208615Sraj /* 417208615Sraj * Search fixup table and call handler if appropriate. 418208615Sraj */ 419208615Sraj for (i = 0; fdt_fixup_table[i].model != NULL; i++) { 420208615Sraj if (strncmp(model, fdt_fixup_table[i].model, 421208615Sraj FDT_MODEL_LEN) != 0) 422208615Sraj continue; 423208615Sraj 424208615Sraj if (fdt_fixup_table[i].handler != NULL) 425208615Sraj (*fdt_fixup_table[i].handler)(root); 426208615Sraj } 427208615Sraj 428208615Sraj return (0); 429208615Sraj} 430208615Sraj 431208615Srajstatic int 432212477Smariusofw_fdt_interpret(ofw_t ofw, const char *cmd, int nret, cell_t *retvals) 433208615Sraj{ 434208615Sraj int rv; 435208615Sraj 436208615Sraj /* 437208615Sraj * Note: FDT does not have the possibility to 'interpret' commands, 438208615Sraj * but we abuse the interface a bit to use it for doing non-standard 439208615Sraj * operations on the device tree blob. 440208615Sraj * 441208615Sraj * Currently the only supported 'command' is to trigger performing 442208615Sraj * fixups. 443208615Sraj */ 444208615Sraj if (strncmp("perform-fixup", cmd, 13) != 0) 445208615Sraj return (0); 446208615Sraj 447208615Sraj rv = ofw_fdt_fixup(ofw); 448208615Sraj if (nret > 0) 449208615Sraj retvals[0] = rv; 450208615Sraj 451208615Sraj return (rv); 452208615Sraj} 453