162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * tree.c: Basic device tree traversal/scanning for the Linux 462306a36Sopenharmony_ci * prom library. 562306a36Sopenharmony_ci * 662306a36Sopenharmony_ci * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu) 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#include <linux/string.h> 1062306a36Sopenharmony_ci#include <linux/types.h> 1162306a36Sopenharmony_ci#include <linux/kernel.h> 1262306a36Sopenharmony_ci#include <linux/sched.h> 1362306a36Sopenharmony_ci#include <linux/ctype.h> 1462306a36Sopenharmony_ci#include <linux/module.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#include <asm/openprom.h> 1762306a36Sopenharmony_ci#include <asm/oplib.h> 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ciextern void restore_current(void); 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistatic char promlib_buf[128]; 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci/* Internal version of prom_getchild that does not alter return values. */ 2462306a36Sopenharmony_cistatic phandle __prom_getchild(phandle node) 2562306a36Sopenharmony_ci{ 2662306a36Sopenharmony_ci unsigned long flags; 2762306a36Sopenharmony_ci phandle cnode; 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci spin_lock_irqsave(&prom_lock, flags); 3062306a36Sopenharmony_ci cnode = prom_nodeops->no_child(node); 3162306a36Sopenharmony_ci restore_current(); 3262306a36Sopenharmony_ci spin_unlock_irqrestore(&prom_lock, flags); 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci return cnode; 3562306a36Sopenharmony_ci} 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci/* Return the child of node 'node' or zero if no this node has no 3862306a36Sopenharmony_ci * direct descendent. 3962306a36Sopenharmony_ci */ 4062306a36Sopenharmony_ciphandle prom_getchild(phandle node) 4162306a36Sopenharmony_ci{ 4262306a36Sopenharmony_ci phandle cnode; 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci if ((s32)node == -1) 4562306a36Sopenharmony_ci return 0; 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci cnode = __prom_getchild(node); 4862306a36Sopenharmony_ci if (cnode == 0 || (s32)cnode == -1) 4962306a36Sopenharmony_ci return 0; 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_ci return cnode; 5262306a36Sopenharmony_ci} 5362306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getchild); 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_ci/* Internal version of prom_getsibling that does not alter return values. */ 5662306a36Sopenharmony_cistatic phandle __prom_getsibling(phandle node) 5762306a36Sopenharmony_ci{ 5862306a36Sopenharmony_ci unsigned long flags; 5962306a36Sopenharmony_ci phandle cnode; 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci spin_lock_irqsave(&prom_lock, flags); 6262306a36Sopenharmony_ci cnode = prom_nodeops->no_nextnode(node); 6362306a36Sopenharmony_ci restore_current(); 6462306a36Sopenharmony_ci spin_unlock_irqrestore(&prom_lock, flags); 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci return cnode; 6762306a36Sopenharmony_ci} 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_ci/* Return the next sibling of node 'node' or zero if no more siblings 7062306a36Sopenharmony_ci * at this level of depth in the tree. 7162306a36Sopenharmony_ci */ 7262306a36Sopenharmony_ciphandle prom_getsibling(phandle node) 7362306a36Sopenharmony_ci{ 7462306a36Sopenharmony_ci phandle sibnode; 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci if ((s32)node == -1) 7762306a36Sopenharmony_ci return 0; 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_ci sibnode = __prom_getsibling(node); 8062306a36Sopenharmony_ci if (sibnode == 0 || (s32)sibnode == -1) 8162306a36Sopenharmony_ci return 0; 8262306a36Sopenharmony_ci 8362306a36Sopenharmony_ci return sibnode; 8462306a36Sopenharmony_ci} 8562306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getsibling); 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_ci/* Return the length in bytes of property 'prop' at node 'node'. 8862306a36Sopenharmony_ci * Return -1 on error. 8962306a36Sopenharmony_ci */ 9062306a36Sopenharmony_ciint prom_getproplen(phandle node, const char *prop) 9162306a36Sopenharmony_ci{ 9262306a36Sopenharmony_ci int ret; 9362306a36Sopenharmony_ci unsigned long flags; 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_ci if((!node) || (!prop)) 9662306a36Sopenharmony_ci return -1; 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_ci spin_lock_irqsave(&prom_lock, flags); 9962306a36Sopenharmony_ci ret = prom_nodeops->no_proplen(node, prop); 10062306a36Sopenharmony_ci restore_current(); 10162306a36Sopenharmony_ci spin_unlock_irqrestore(&prom_lock, flags); 10262306a36Sopenharmony_ci return ret; 10362306a36Sopenharmony_ci} 10462306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getproplen); 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci/* Acquire a property 'prop' at node 'node' and place it in 10762306a36Sopenharmony_ci * 'buffer' which has a size of 'bufsize'. If the acquisition 10862306a36Sopenharmony_ci * was successful the length will be returned, else -1 is returned. 10962306a36Sopenharmony_ci */ 11062306a36Sopenharmony_ciint prom_getproperty(phandle node, const char *prop, char *buffer, int bufsize) 11162306a36Sopenharmony_ci{ 11262306a36Sopenharmony_ci int plen, ret; 11362306a36Sopenharmony_ci unsigned long flags; 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci plen = prom_getproplen(node, prop); 11662306a36Sopenharmony_ci if((plen > bufsize) || (plen == 0) || (plen == -1)) 11762306a36Sopenharmony_ci return -1; 11862306a36Sopenharmony_ci /* Ok, things seem all right. */ 11962306a36Sopenharmony_ci spin_lock_irqsave(&prom_lock, flags); 12062306a36Sopenharmony_ci ret = prom_nodeops->no_getprop(node, prop, buffer); 12162306a36Sopenharmony_ci restore_current(); 12262306a36Sopenharmony_ci spin_unlock_irqrestore(&prom_lock, flags); 12362306a36Sopenharmony_ci return ret; 12462306a36Sopenharmony_ci} 12562306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getproperty); 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_ci/* Acquire an integer property and return its value. Returns -1 12862306a36Sopenharmony_ci * on failure. 12962306a36Sopenharmony_ci */ 13062306a36Sopenharmony_ciint prom_getint(phandle node, char *prop) 13162306a36Sopenharmony_ci{ 13262306a36Sopenharmony_ci static int intprop; 13362306a36Sopenharmony_ci 13462306a36Sopenharmony_ci if(prom_getproperty(node, prop, (char *) &intprop, sizeof(int)) != -1) 13562306a36Sopenharmony_ci return intprop; 13662306a36Sopenharmony_ci 13762306a36Sopenharmony_ci return -1; 13862306a36Sopenharmony_ci} 13962306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getint); 14062306a36Sopenharmony_ci 14162306a36Sopenharmony_ci/* Acquire an integer property, upon error return the passed default 14262306a36Sopenharmony_ci * integer. 14362306a36Sopenharmony_ci */ 14462306a36Sopenharmony_ciint prom_getintdefault(phandle node, char *property, int deflt) 14562306a36Sopenharmony_ci{ 14662306a36Sopenharmony_ci int retval; 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_ci retval = prom_getint(node, property); 14962306a36Sopenharmony_ci if(retval == -1) return deflt; 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci return retval; 15262306a36Sopenharmony_ci} 15362306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getintdefault); 15462306a36Sopenharmony_ci 15562306a36Sopenharmony_ci/* Acquire a boolean property, 1=TRUE 0=FALSE. */ 15662306a36Sopenharmony_ciint prom_getbool(phandle node, char *prop) 15762306a36Sopenharmony_ci{ 15862306a36Sopenharmony_ci int retval; 15962306a36Sopenharmony_ci 16062306a36Sopenharmony_ci retval = prom_getproplen(node, prop); 16162306a36Sopenharmony_ci if(retval == -1) return 0; 16262306a36Sopenharmony_ci return 1; 16362306a36Sopenharmony_ci} 16462306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getbool); 16562306a36Sopenharmony_ci 16662306a36Sopenharmony_ci/* Acquire a property whose value is a string, returns a null 16762306a36Sopenharmony_ci * string on error. The char pointer is the user supplied string 16862306a36Sopenharmony_ci * buffer. 16962306a36Sopenharmony_ci */ 17062306a36Sopenharmony_civoid prom_getstring(phandle node, char *prop, char *user_buf, int ubuf_size) 17162306a36Sopenharmony_ci{ 17262306a36Sopenharmony_ci int len; 17362306a36Sopenharmony_ci 17462306a36Sopenharmony_ci len = prom_getproperty(node, prop, user_buf, ubuf_size); 17562306a36Sopenharmony_ci if(len != -1) return; 17662306a36Sopenharmony_ci user_buf[0] = 0; 17762306a36Sopenharmony_ci} 17862306a36Sopenharmony_ciEXPORT_SYMBOL(prom_getstring); 17962306a36Sopenharmony_ci 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_ci/* Search siblings at 'node_start' for a node with name 18262306a36Sopenharmony_ci * 'nodename'. Return node if successful, zero if not. 18362306a36Sopenharmony_ci */ 18462306a36Sopenharmony_ciphandle prom_searchsiblings(phandle node_start, char *nodename) 18562306a36Sopenharmony_ci{ 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_ci phandle thisnode; 18862306a36Sopenharmony_ci int error; 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_ci for(thisnode = node_start; thisnode; 19162306a36Sopenharmony_ci thisnode=prom_getsibling(thisnode)) { 19262306a36Sopenharmony_ci error = prom_getproperty(thisnode, "name", promlib_buf, 19362306a36Sopenharmony_ci sizeof(promlib_buf)); 19462306a36Sopenharmony_ci /* Should this ever happen? */ 19562306a36Sopenharmony_ci if(error == -1) continue; 19662306a36Sopenharmony_ci if(strcmp(nodename, promlib_buf)==0) return thisnode; 19762306a36Sopenharmony_ci } 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_ci return 0; 20062306a36Sopenharmony_ci} 20162306a36Sopenharmony_ciEXPORT_SYMBOL(prom_searchsiblings); 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_ci/* Interal version of nextprop that does not alter return values. */ 20462306a36Sopenharmony_cistatic char *__prom_nextprop(phandle node, char * oprop) 20562306a36Sopenharmony_ci{ 20662306a36Sopenharmony_ci unsigned long flags; 20762306a36Sopenharmony_ci char *prop; 20862306a36Sopenharmony_ci 20962306a36Sopenharmony_ci spin_lock_irqsave(&prom_lock, flags); 21062306a36Sopenharmony_ci prop = prom_nodeops->no_nextprop(node, oprop); 21162306a36Sopenharmony_ci restore_current(); 21262306a36Sopenharmony_ci spin_unlock_irqrestore(&prom_lock, flags); 21362306a36Sopenharmony_ci 21462306a36Sopenharmony_ci return prop; 21562306a36Sopenharmony_ci} 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_ci/* Return the property type string after property type 'oprop' 21862306a36Sopenharmony_ci * at node 'node' . Returns empty string if no more 21962306a36Sopenharmony_ci * property types for this node. 22062306a36Sopenharmony_ci */ 22162306a36Sopenharmony_cichar *prom_nextprop(phandle node, char *oprop, char *buffer) 22262306a36Sopenharmony_ci{ 22362306a36Sopenharmony_ci if (node == 0 || (s32)node == -1) 22462306a36Sopenharmony_ci return ""; 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ci return __prom_nextprop(node, oprop); 22762306a36Sopenharmony_ci} 22862306a36Sopenharmony_ciEXPORT_SYMBOL(prom_nextprop); 22962306a36Sopenharmony_ci 23062306a36Sopenharmony_ciphandle prom_finddevice(char *name) 23162306a36Sopenharmony_ci{ 23262306a36Sopenharmony_ci char nbuf[128]; 23362306a36Sopenharmony_ci char *s = name, *d; 23462306a36Sopenharmony_ci phandle node = prom_root_node, node2; 23562306a36Sopenharmony_ci unsigned int which_io, phys_addr; 23662306a36Sopenharmony_ci struct linux_prom_registers reg[PROMREG_MAX]; 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_ci while (*s++) { 23962306a36Sopenharmony_ci if (!*s) return node; /* path '.../' is legal */ 24062306a36Sopenharmony_ci node = prom_getchild(node); 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci for (d = nbuf; *s != 0 && *s != '@' && *s != '/';) 24362306a36Sopenharmony_ci *d++ = *s++; 24462306a36Sopenharmony_ci *d = 0; 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ci node = prom_searchsiblings(node, nbuf); 24762306a36Sopenharmony_ci if (!node) 24862306a36Sopenharmony_ci return 0; 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_ci if (*s == '@') { 25162306a36Sopenharmony_ci if (isxdigit(s[1]) && s[2] == ',') { 25262306a36Sopenharmony_ci which_io = simple_strtoul(s+1, NULL, 16); 25362306a36Sopenharmony_ci phys_addr = simple_strtoul(s+3, &d, 16); 25462306a36Sopenharmony_ci if (d != s + 3 && (!*d || *d == '/') 25562306a36Sopenharmony_ci && d <= s + 3 + 8) { 25662306a36Sopenharmony_ci node2 = node; 25762306a36Sopenharmony_ci while (node2 && (s32)node2 != -1) { 25862306a36Sopenharmony_ci if (prom_getproperty (node2, "reg", (char *)reg, sizeof (reg)) > 0) { 25962306a36Sopenharmony_ci if (which_io == reg[0].which_io && phys_addr == reg[0].phys_addr) { 26062306a36Sopenharmony_ci node = node2; 26162306a36Sopenharmony_ci break; 26262306a36Sopenharmony_ci } 26362306a36Sopenharmony_ci } 26462306a36Sopenharmony_ci node2 = prom_getsibling(node2); 26562306a36Sopenharmony_ci if (!node2 || (s32)node2 == -1) 26662306a36Sopenharmony_ci break; 26762306a36Sopenharmony_ci node2 = prom_searchsiblings(prom_getsibling(node2), nbuf); 26862306a36Sopenharmony_ci } 26962306a36Sopenharmony_ci } 27062306a36Sopenharmony_ci } 27162306a36Sopenharmony_ci while (*s != 0 && *s != '/') s++; 27262306a36Sopenharmony_ci } 27362306a36Sopenharmony_ci } 27462306a36Sopenharmony_ci return node; 27562306a36Sopenharmony_ci} 27662306a36Sopenharmony_ciEXPORT_SYMBOL(prom_finddevice); 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_ci/* Set property 'pname' at node 'node' to value 'value' which has a length 27962306a36Sopenharmony_ci * of 'size' bytes. Return the number of bytes the prom accepted. 28062306a36Sopenharmony_ci */ 28162306a36Sopenharmony_ciint prom_setprop(phandle node, const char *pname, char *value, int size) 28262306a36Sopenharmony_ci{ 28362306a36Sopenharmony_ci unsigned long flags; 28462306a36Sopenharmony_ci int ret; 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci if (size == 0) 28762306a36Sopenharmony_ci return 0; 28862306a36Sopenharmony_ci if ((pname == NULL) || (value == NULL)) 28962306a36Sopenharmony_ci return 0; 29062306a36Sopenharmony_ci spin_lock_irqsave(&prom_lock, flags); 29162306a36Sopenharmony_ci ret = prom_nodeops->no_setprop(node, pname, value, size); 29262306a36Sopenharmony_ci restore_current(); 29362306a36Sopenharmony_ci spin_unlock_irqrestore(&prom_lock, flags); 29462306a36Sopenharmony_ci return ret; 29562306a36Sopenharmony_ci} 29662306a36Sopenharmony_ciEXPORT_SYMBOL(prom_setprop); 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_ciphandle prom_inst2pkg(int inst) 29962306a36Sopenharmony_ci{ 30062306a36Sopenharmony_ci phandle node; 30162306a36Sopenharmony_ci unsigned long flags; 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_ci spin_lock_irqsave(&prom_lock, flags); 30462306a36Sopenharmony_ci node = (*romvec->pv_v2devops.v2_inst2pkg)(inst); 30562306a36Sopenharmony_ci restore_current(); 30662306a36Sopenharmony_ci spin_unlock_irqrestore(&prom_lock, flags); 30762306a36Sopenharmony_ci if ((s32)node == -1) 30862306a36Sopenharmony_ci return 0; 30962306a36Sopenharmony_ci return node; 31062306a36Sopenharmony_ci} 311