378 lines
8.4 KiB
C
378 lines
8.4 KiB
C
/* $Id: tree.c,v 1.10 1998/01/10 22:39:00 ecd Exp $
|
|
* tree.c: Basic device tree traversal/scanning for the Linux
|
|
* prom library.
|
|
*
|
|
* Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
|
|
* Copyright (C) 1996,1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
|
|
*/
|
|
|
|
#include <linux/string.h>
|
|
#include <linux/types.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/sched.h>
|
|
|
|
#include <asm/openprom.h>
|
|
#include <asm/oplib.h>
|
|
|
|
/* Return the child of node 'node' or zero if no this node has no
|
|
* direct descendent.
|
|
*/
|
|
__inline__ int
|
|
__prom_getchild(int node)
|
|
{
|
|
return p1275_cmd ("child", P1275_INOUT(1, 1), node);
|
|
}
|
|
|
|
__inline__ int
|
|
prom_getchild(int node)
|
|
{
|
|
int cnode;
|
|
|
|
if(node == -1) return 0;
|
|
cnode = __prom_getchild(node);
|
|
if(cnode == -1) return 0;
|
|
return (int)cnode;
|
|
}
|
|
|
|
__inline__ int
|
|
prom_getparent(int node)
|
|
{
|
|
int cnode;
|
|
|
|
if(node == -1) return 0;
|
|
cnode = p1275_cmd ("parent", P1275_INOUT(1, 1), node);
|
|
if(cnode == -1) return 0;
|
|
return (int)cnode;
|
|
}
|
|
|
|
/* Return the next sibling of node 'node' or zero if no more siblings
|
|
* at this level of depth in the tree.
|
|
*/
|
|
__inline__ int
|
|
__prom_getsibling(int node)
|
|
{
|
|
return p1275_cmd ("peer", P1275_INOUT(1, 1), node);
|
|
}
|
|
|
|
__inline__ int
|
|
prom_getsibling(int node)
|
|
{
|
|
int sibnode;
|
|
|
|
if(node == -1) return 0;
|
|
sibnode = __prom_getsibling(node);
|
|
if(sibnode == -1) return 0;
|
|
return sibnode;
|
|
}
|
|
|
|
/* Return the length in bytes of property 'prop' at node 'node'.
|
|
* Return -1 on error.
|
|
*/
|
|
__inline__ int
|
|
prom_getproplen(int node, char *prop)
|
|
{
|
|
if((!node) || (!prop)) return -1;
|
|
return p1275_cmd ("getproplen",
|
|
P1275_ARG(1,P1275_ARG_IN_STRING)|
|
|
P1275_INOUT(2, 1),
|
|
node, prop);
|
|
}
|
|
|
|
/* Acquire a property 'prop' at node 'node' and place it in
|
|
* 'buffer' which has a size of 'bufsize'. If the acquisition
|
|
* was successful the length will be returned, else -1 is returned.
|
|
*/
|
|
__inline__ int
|
|
prom_getproperty(int node, char *prop, char *buffer, int bufsize)
|
|
{
|
|
int plen;
|
|
|
|
plen = prom_getproplen(node, prop);
|
|
if((plen > bufsize) || (plen == 0) || (plen == -1))
|
|
return -1;
|
|
else {
|
|
/* Ok, things seem all right. */
|
|
return p1275_cmd ("getprop",
|
|
P1275_ARG(1,P1275_ARG_IN_STRING)|
|
|
P1275_ARG(2,P1275_ARG_OUT_BUF)|
|
|
P1275_INOUT(4, 1),
|
|
node, prop, buffer, P1275_SIZE(plen));
|
|
}
|
|
}
|
|
|
|
/* Acquire an integer property and return its value. Returns -1
|
|
* on failure.
|
|
*/
|
|
__inline__ int
|
|
prom_getint(int node, char *prop)
|
|
{
|
|
int intprop;
|
|
|
|
if(prom_getproperty(node, prop, (char *) &intprop, sizeof(int)) != -1)
|
|
return intprop;
|
|
|
|
return -1;
|
|
}
|
|
|
|
/* Acquire an integer property, upon error return the passed default
|
|
* integer.
|
|
*/
|
|
|
|
int
|
|
prom_getintdefault(int node, char *property, int deflt)
|
|
{
|
|
int retval;
|
|
|
|
retval = prom_getint(node, property);
|
|
if(retval == -1) return deflt;
|
|
|
|
return retval;
|
|
}
|
|
|
|
/* Acquire a boolean property, 1=TRUE 0=FALSE. */
|
|
int
|
|
prom_getbool(int node, char *prop)
|
|
{
|
|
int retval;
|
|
|
|
retval = prom_getproplen(node, prop);
|
|
if(retval == -1) return 0;
|
|
return 1;
|
|
}
|
|
|
|
/* Acquire a property whose value is a string, returns a null
|
|
* string on error. The char pointer is the user supplied string
|
|
* buffer.
|
|
*/
|
|
void
|
|
prom_getstring(int node, char *prop, char *user_buf, int ubuf_size)
|
|
{
|
|
int len;
|
|
|
|
len = prom_getproperty(node, prop, user_buf, ubuf_size);
|
|
if(len != -1) return;
|
|
user_buf[0] = 0;
|
|
return;
|
|
}
|
|
|
|
|
|
/* Does the device at node 'node' have name 'name'?
|
|
* YES = 1 NO = 0
|
|
*/
|
|
int
|
|
prom_nodematch(int node, char *name)
|
|
{
|
|
char namebuf[128];
|
|
prom_getproperty(node, "name", namebuf, sizeof(namebuf));
|
|
if(strcmp(namebuf, name) == 0) return 1;
|
|
return 0;
|
|
}
|
|
|
|
/* Search siblings at 'node_start' for a node with name
|
|
* 'nodename'. Return node if successful, zero if not.
|
|
*/
|
|
int
|
|
prom_searchsiblings(int node_start, char *nodename)
|
|
{
|
|
|
|
int thisnode, error;
|
|
char promlib_buf[128];
|
|
|
|
for(thisnode = node_start; thisnode;
|
|
thisnode=prom_getsibling(thisnode)) {
|
|
error = prom_getproperty(thisnode, "name", promlib_buf,
|
|
sizeof(promlib_buf));
|
|
/* Should this ever happen? */
|
|
if(error == -1) continue;
|
|
if(strcmp(nodename, promlib_buf)==0) return thisnode;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Gets name in the {name@x,yyyyy|name (if no reg)} form */
|
|
int
|
|
prom_getname (int node, char *buffer, int len)
|
|
{
|
|
int i, sbus = 0;
|
|
int pci = 0, ebus = 0, ide = 0;
|
|
struct linux_prom_registers *reg;
|
|
struct linux_prom64_registers reg64[PROMREG_MAX];
|
|
|
|
for (sbus = prom_getparent (node); sbus; sbus = prom_getparent (sbus)) {
|
|
i = prom_getproperty (sbus, "name", buffer, len);
|
|
if (i > 0) {
|
|
buffer [i] = 0;
|
|
if (!strcmp (buffer, "sbus"))
|
|
goto getit;
|
|
}
|
|
}
|
|
if ((pci = prom_getparent (node))) {
|
|
i = prom_getproperty (pci, "name", buffer, len);
|
|
if (i > 0) {
|
|
buffer [i] = 0;
|
|
if (!strcmp (buffer, "pci"))
|
|
goto getit;
|
|
}
|
|
pci = 0;
|
|
}
|
|
if ((ebus = prom_getparent (node))) {
|
|
i = prom_getproperty (ebus, "name", buffer, len);
|
|
if (i > 0) {
|
|
buffer[i] = 0;
|
|
if (!strcmp (buffer, "ebus"))
|
|
goto getit;
|
|
}
|
|
ebus = 0;
|
|
}
|
|
if ((ide = prom_getparent (node))) {
|
|
i = prom_getproperty (ide, "name", buffer, len);
|
|
if (i > 0) {
|
|
buffer [i] = 0;
|
|
if (!strcmp (buffer, "ide"))
|
|
goto getit;
|
|
}
|
|
ide = 0;
|
|
}
|
|
getit:
|
|
i = prom_getproperty (node, "name", buffer, len);
|
|
if (i <= 0) {
|
|
buffer [0] = 0;
|
|
return -1;
|
|
}
|
|
buffer [i] = 0;
|
|
len -= i;
|
|
i = prom_getproperty (node, "reg", (char *)reg64, sizeof (reg64));
|
|
if (i <= 0) return 0;
|
|
if (len < 16) return -1;
|
|
buffer = strchr (buffer, 0);
|
|
if (sbus) {
|
|
reg = (struct linux_prom_registers *)reg64;
|
|
sprintf (buffer, "@%x,%x", reg[0].which_io, (uint)reg[0].phys_addr);
|
|
} else if (pci) {
|
|
int dev, fn;
|
|
reg = (struct linux_prom_registers *)reg64;
|
|
fn = (reg[0].which_io >> 8) & 0x07;
|
|
dev = (reg[0].which_io >> 11) & 0x1f;
|
|
if (fn)
|
|
sprintf (buffer, "@%x,%x", dev, fn);
|
|
else
|
|
sprintf (buffer, "@%x", dev);
|
|
} else if (ebus) {
|
|
reg = (struct linux_prom_registers *)reg64;
|
|
sprintf (buffer, "@%x,%x", reg[0].which_io, reg[0].phys_addr);
|
|
} else if (ide) {
|
|
reg = (struct linux_prom_registers *)reg64;
|
|
sprintf (buffer, "@%x,%x", reg[0].which_io, reg[0].phys_addr);
|
|
} else if (i == 4) { /* Happens on 8042's children on Ultra/PCI. */
|
|
reg = (struct linux_prom_registers *)reg64;
|
|
sprintf (buffer, "@%x", reg[0].which_io);
|
|
} else {
|
|
sprintf (buffer, "@%x,%x",
|
|
(unsigned int)(reg64[0].phys_addr >> 36),
|
|
(unsigned int)(reg64[0].phys_addr));
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* Return the first property type for node 'node'.
|
|
* buffer should be at least 32B in length
|
|
*/
|
|
__inline__ char *
|
|
prom_firstprop(int node, char *buffer)
|
|
{
|
|
*buffer = 0;
|
|
if(node == -1) return buffer;
|
|
p1275_cmd ("nextprop", P1275_ARG(2,P1275_ARG_OUT_32B)|
|
|
P1275_INOUT(3, 0),
|
|
node, (char *) 0x0, buffer);
|
|
return buffer;
|
|
}
|
|
|
|
/* Return the property type string after property type 'oprop'
|
|
* at node 'node' . Returns NULL string if no more
|
|
* property types for this node.
|
|
*/
|
|
__inline__ char *
|
|
prom_nextprop(int node, char *oprop, char *buffer)
|
|
{
|
|
char buf[32];
|
|
|
|
if(node == -1) {
|
|
*buffer = 0;
|
|
return buffer;
|
|
}
|
|
if (oprop == buffer) {
|
|
strcpy (buf, oprop);
|
|
oprop = buf;
|
|
}
|
|
p1275_cmd ("nextprop", P1275_ARG(1,P1275_ARG_IN_STRING)|
|
|
P1275_ARG(2,P1275_ARG_OUT_32B)|
|
|
P1275_INOUT(3, 0),
|
|
node, oprop, buffer);
|
|
return buffer;
|
|
}
|
|
|
|
int
|
|
prom_finddevice(char *name)
|
|
{
|
|
if(!name) return 0;
|
|
return p1275_cmd ("finddevice", P1275_ARG(0,P1275_ARG_IN_STRING)|
|
|
P1275_INOUT(1, 1),
|
|
name);
|
|
}
|
|
|
|
int prom_node_has_property(int node, char *prop)
|
|
{
|
|
char buf [32];
|
|
|
|
*buf = 0;
|
|
do {
|
|
prom_nextprop(node, buf, buf);
|
|
if(!strcmp(buf, prop))
|
|
return 1;
|
|
} while (*buf);
|
|
return 0;
|
|
}
|
|
|
|
/* Set property 'pname' at node 'node' to value 'value' which has a length
|
|
* of 'size' bytes. Return the number of bytes the prom accepted.
|
|
*/
|
|
int
|
|
prom_setprop(int node, char *pname, char *value, int size)
|
|
{
|
|
if(size == 0) return 0;
|
|
if((pname == 0) || (value == 0)) return 0;
|
|
|
|
return p1275_cmd ("setprop", P1275_ARG(1,P1275_ARG_IN_STRING)|
|
|
P1275_ARG(2,P1275_ARG_IN_BUF)|
|
|
P1275_INOUT(4, 1),
|
|
node, pname, value, P1275_SIZE(size));
|
|
}
|
|
|
|
__inline__ int
|
|
prom_inst2pkg(int inst)
|
|
{
|
|
int node;
|
|
|
|
node = p1275_cmd ("instance-to-package", P1275_INOUT(1, 1), inst);
|
|
if (node == -1) return 0;
|
|
return node;
|
|
}
|
|
|
|
/* Return 'node' assigned to a particular prom 'path'
|
|
* FIXME: Should work for v0 as well
|
|
*/
|
|
int
|
|
prom_pathtoinode(char *path)
|
|
{
|
|
int node, inst;
|
|
|
|
inst = prom_devopen (path);
|
|
if (inst == 0) return 0;
|
|
node = prom_inst2pkg (inst);
|
|
prom_devclose (inst);
|
|
if (node == -1) return 0;
|
|
return node;
|
|
}
|