Home | History | Annotate | Line # | Download | only in ofctl
ofctl.c revision 1.1
      1  1.1  macallan /*	$NetBSD: ofctl.c,v 1.1 2006/09/29 19:03:11 macallan Exp $	*/
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.1  macallan  * Copyright (c) 2006 The NetBSD Foundation, Inc.
      5  1.1  macallan  * All rights reserved.
      6  1.1  macallan  *
      7  1.1  macallan  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  macallan  * by Matt Thomas.
      9  1.1  macallan  *
     10  1.1  macallan  * Redistribution and use in source and binary forms, with or without
     11  1.1  macallan  * modification, are permitted provided that the following conditions
     12  1.1  macallan  * are met:
     13  1.1  macallan  * 1. Redistributions of source code must retain the above copyright
     14  1.1  macallan  *    notice, this list of conditions and the following disclaimer.
     15  1.1  macallan  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  macallan  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  macallan  *    documentation and/or other materials provided with the distribution.
     18  1.1  macallan  * 3. Neither the name of The NetBSD Foundation nor the names of its
     19  1.1  macallan  *    contributors may be used to endorse or promote products derived
     20  1.1  macallan  *    from this software without specific prior written permission.
     21  1.1  macallan  *
     22  1.1  macallan  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     23  1.1  macallan  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     24  1.1  macallan  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     25  1.1  macallan  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     26  1.1  macallan  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     27  1.1  macallan  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     28  1.1  macallan  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     29  1.1  macallan  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     30  1.1  macallan  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     31  1.1  macallan  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     32  1.1  macallan  * POSSIBILITY OF SUCH DAMAGE.
     33  1.1  macallan  */
     34  1.1  macallan 
     35  1.1  macallan #include <stdio.h>
     36  1.1  macallan #include <stdlib.h>
     37  1.1  macallan #include <unistd.h>
     38  1.1  macallan #include <errno.h>
     39  1.1  macallan #include <ctype.h>
     40  1.1  macallan #include <string.h>
     41  1.1  macallan #include <assert.h>
     42  1.1  macallan #include <err.h>
     43  1.1  macallan #include <sys/types.h>
     44  1.1  macallan #include <sys/ioctl.h>
     45  1.1  macallan #include <sys/file.h>
     46  1.1  macallan #include <sys/queue.h>
     47  1.1  macallan #include <dev/ofw/openfirmio.h>
     48  1.1  macallan 
     49  1.1  macallan static void oflist(int, const char *, int, void *, size_t);
     50  1.1  macallan static void ofprop(int);
     51  1.1  macallan static void ofgetprop(int, char *);
     52  1.1  macallan #if 0
     53  1.1  macallan static int isstrprint(const char *, size_t, int);
     54  1.1  macallan #endif
     55  1.1  macallan 
     56  1.1  macallan static int lflag;
     57  1.1  macallan static int pflag;
     58  1.1  macallan 
     59  1.1  macallan struct of_node {
     60  1.1  macallan 	TAILQ_ENTRY(of_node) of_sibling;
     61  1.1  macallan 	TAILQ_HEAD(,of_node) of_children;
     62  1.1  macallan 	TAILQ_HEAD(,of_prop) of_properties;
     63  1.1  macallan 	struct of_node *of_parent;
     64  1.1  macallan 	struct of_prop *of_name;
     65  1.1  macallan 	struct of_prop *of_device_type;
     66  1.1  macallan 	struct of_prop *of_reg;
     67  1.1  macallan 	int of_nodeid;
     68  1.1  macallan };
     69  1.1  macallan 
     70  1.1  macallan struct of_prop {
     71  1.1  macallan 	TAILQ_ENTRY(of_prop) prop_sibling;
     72  1.1  macallan 	char *prop_name;
     73  1.1  macallan 	u_int8_t *prop_data;
     74  1.1  macallan 	size_t prop_length;
     75  1.1  macallan 	size_t prop_namelen;
     76  1.1  macallan };
     77  1.1  macallan 
     78  1.1  macallan struct of_node of_root;
     79  1.1  macallan unsigned long of_node_count;
     80  1.1  macallan unsigned long of_prop_count;
     81  1.1  macallan 
     82  1.1  macallan int OF_parent(int);
     83  1.1  macallan int OF_child(int);
     84  1.1  macallan int OF_peer(int);
     85  1.1  macallan int OF_finddevice(const char *);
     86  1.1  macallan int OF_getproplen(int, char *);
     87  1.1  macallan int OF_getprop(int, char *, void *, size_t);
     88  1.1  macallan int OF_nextprop(int, char *, void *);
     89  1.1  macallan 
     90  1.1  macallan struct of_prop *of_tree_getprop(int, char *);
     91  1.1  macallan 
     92  1.1  macallan static void
     93  1.1  macallan of_tree_mkprop(int fd, struct of_node *node, char *name)
     94  1.1  macallan {
     95  1.1  macallan 	struct ofiocdesc ofio;
     96  1.1  macallan 	struct of_prop *prop;
     97  1.1  macallan 
     98  1.1  macallan 	prop = malloc(sizeof(*prop) + strlen(name) + 1);
     99  1.1  macallan 	if (prop == NULL)
    100  1.1  macallan 		err(1, "malloc(%lu)", (unsigned long) sizeof(*prop));
    101  1.1  macallan 
    102  1.1  macallan 	memset(prop, 0, sizeof(*prop));
    103  1.1  macallan 	prop->prop_name = (char *) (prop + 1);
    104  1.1  macallan 	prop->prop_namelen = strlen(name);
    105  1.1  macallan 	memcpy(prop->prop_name, name, prop->prop_namelen+1);
    106  1.1  macallan 	TAILQ_INSERT_TAIL(&node->of_properties, prop, prop_sibling);
    107  1.1  macallan 
    108  1.1  macallan 	if (!strcmp(name, "name"))
    109  1.1  macallan 		node->of_name = prop;
    110  1.1  macallan 	else if (!strcmp(name, "device_type"))
    111  1.1  macallan 		node->of_device_type = prop;
    112  1.1  macallan 	else if (!strcmp(name, "reg"))
    113  1.1  macallan 		node->of_reg = prop;
    114  1.1  macallan 
    115  1.1  macallan 	of_prop_count++;
    116  1.1  macallan 
    117  1.1  macallan 	ofio.of_nodeid = node->of_nodeid;
    118  1.1  macallan 	ofio.of_name = name;
    119  1.1  macallan 	ofio.of_namelen = prop->prop_namelen;
    120  1.1  macallan 	ofio.of_buf = NULL;
    121  1.1  macallan 	ofio.of_buflen = 32;
    122  1.1  macallan 
    123  1.1  macallan    again:
    124  1.1  macallan 	if (ofio.of_buf != NULL)
    125  1.1  macallan 		free(ofio.of_buf);
    126  1.1  macallan 	ofio.of_buf = malloc(ofio.of_buflen);
    127  1.1  macallan 	if (ofio.of_buf == NULL)
    128  1.1  macallan 		err(1, "malloc(%lu)", (unsigned long) ofio.of_buflen);
    129  1.1  macallan 	if (ioctl(fd, OFIOCGET, &ofio) < 0) {
    130  1.1  macallan 		if (errno == ENOMEM) {
    131  1.1  macallan 			ofio.of_buflen *= 2;
    132  1.1  macallan 			goto again;
    133  1.1  macallan 		}
    134  1.1  macallan 		warn("OFIOCGET(%d, \"%s\")", fd, name);
    135  1.1  macallan 		prop->prop_data = NULL;
    136  1.1  macallan 		prop->prop_length = 0;
    137  1.1  macallan 		free(ofio.of_buf);
    138  1.1  macallan 		return;
    139  1.1  macallan 	}
    140  1.1  macallan 	prop->prop_data = (u_int8_t *)ofio.of_buf;
    141  1.1  macallan 	prop->prop_length = ofio.of_buflen;
    142  1.1  macallan }
    143  1.1  macallan 
    144  1.1  macallan static struct of_node *
    145  1.1  macallan of_tree_mknode(struct of_node *parent, int nodeid)
    146  1.1  macallan {
    147  1.1  macallan 	struct of_node *newnode;
    148  1.1  macallan 	newnode = malloc(sizeof(*newnode));
    149  1.1  macallan 	if (newnode == NULL)
    150  1.1  macallan 		err(1, "malloc(%lu)", (unsigned long) sizeof(*newnode));
    151  1.1  macallan 
    152  1.1  macallan 	of_node_count++;
    153  1.1  macallan 
    154  1.1  macallan 	memset(newnode, 0, sizeof(*newnode));
    155  1.1  macallan 	TAILQ_INIT(&newnode->of_children);
    156  1.1  macallan 	TAILQ_INIT(&newnode->of_properties);
    157  1.1  macallan 	newnode->of_nodeid = nodeid;
    158  1.1  macallan 	newnode->of_parent = parent;
    159  1.1  macallan 
    160  1.1  macallan 	TAILQ_INSERT_TAIL(&parent->of_children, newnode, of_sibling);
    161  1.1  macallan 
    162  1.1  macallan 	return newnode;
    163  1.1  macallan }
    164  1.1  macallan 
    165  1.1  macallan static void
    166  1.1  macallan of_tree_fill(int fd, struct of_node *node)
    167  1.1  macallan {
    168  1.1  macallan 	int childid = node->of_nodeid;
    169  1.1  macallan 	struct ofiocdesc ofio;
    170  1.1  macallan 	char namebuf[33];
    171  1.1  macallan 	char newnamebuf[33];
    172  1.1  macallan 
    173  1.1  macallan 	ofio.of_nodeid = node->of_nodeid;
    174  1.1  macallan 	ofio.of_name = namebuf;
    175  1.1  macallan 	ofio.of_namelen = 1;
    176  1.1  macallan 	ofio.of_buf = newnamebuf;
    177  1.1  macallan 
    178  1.1  macallan 	namebuf[0] = '\0';
    179  1.1  macallan 
    180  1.1  macallan 	for (;;) {
    181  1.1  macallan 		ofio.of_buflen = sizeof(newnamebuf);
    182  1.1  macallan 
    183  1.1  macallan 		if (ioctl(fd, OFIOCNEXTPROP, &ofio) < 0) {
    184  1.1  macallan 			if (errno == ENOENT)
    185  1.1  macallan 				break;
    186  1.1  macallan 			err(1, "OFIOCNEXTPROP(%d, %#x, \"%s\")", fd,
    187  1.1  macallan 			    ofio.of_nodeid, ofio.of_name);
    188  1.1  macallan 		}
    189  1.1  macallan 
    190  1.1  macallan 		ofio.of_namelen = ofio.of_buflen;
    191  1.1  macallan 		if (ofio.of_namelen == 0)
    192  1.1  macallan 			break;
    193  1.1  macallan 		newnamebuf[ofio.of_buflen] = '\0';
    194  1.1  macallan 		strcpy(namebuf, newnamebuf);
    195  1.1  macallan 		of_tree_mkprop(fd, node, namebuf);
    196  1.1  macallan 	}
    197  1.1  macallan 
    198  1.1  macallan 	if (ioctl(fd, OFIOCGETCHILD, &childid) < 0)
    199  1.1  macallan 		err(1, "OFIOCGETCHILD(%d, %#x)", fd, childid);
    200  1.1  macallan 
    201  1.1  macallan 	while (childid != 0) {
    202  1.1  macallan 		of_tree_fill(fd, of_tree_mknode(node, childid));
    203  1.1  macallan 		if (ioctl(fd, OFIOCGETNEXT, &childid) < 0)
    204  1.1  macallan 			err(1, "OFIOCGETNEXT(%d, %#x)", fd, childid);
    205  1.1  macallan 	}
    206  1.1  macallan 
    207  1.1  macallan }
    208  1.1  macallan 
    209  1.1  macallan static void
    210  1.1  macallan of_tree_init(int fd)
    211  1.1  macallan {
    212  1.1  macallan 	int rootid = 0;
    213  1.1  macallan 
    214  1.1  macallan 	if (ioctl(fd, OFIOCGETNEXT, &rootid) < 0)
    215  1.1  macallan 		err(1, "OFIOCGETNEXT(%d, %#x)", fd, rootid);
    216  1.1  macallan 
    217  1.1  macallan 	/*
    218  1.1  macallan 	 * Initialize the root node of the OFW tree.
    219  1.1  macallan 	 */
    220  1.1  macallan 	TAILQ_INIT(&of_root.of_children);
    221  1.1  macallan 	TAILQ_INIT(&of_root.of_properties);
    222  1.1  macallan 	of_root.of_nodeid = rootid;
    223  1.1  macallan 
    224  1.1  macallan 	of_tree_fill(fd, &of_root);
    225  1.1  macallan }
    226  1.1  macallan 
    227  1.1  macallan static struct of_node *
    228  1.1  macallan of_tree_walk(struct of_node *node,
    229  1.1  macallan 	struct of_node *(*fn)(struct of_node *, const void *),
    230  1.1  macallan 	const void *ctx)
    231  1.1  macallan {
    232  1.1  macallan 	struct of_node *child, *match;
    233  1.1  macallan 
    234  1.1  macallan 	if ((match = (*fn)(node, ctx)) != NULL)
    235  1.1  macallan 		return match;
    236  1.1  macallan 
    237  1.1  macallan 	TAILQ_FOREACH(child, &node->of_children, of_sibling) {
    238  1.1  macallan 		if ((match = of_tree_walk(child, fn, ctx)) != NULL)
    239  1.1  macallan 			return match;
    240  1.1  macallan 	}
    241  1.1  macallan 	return NULL;
    242  1.1  macallan }
    243  1.1  macallan 
    244  1.1  macallan static struct of_node *
    245  1.1  macallan of_match_by_nodeid(struct of_node *node, const void *ctx)
    246  1.1  macallan {
    247  1.1  macallan 	return (node->of_nodeid == *(const int *) ctx) ? node : NULL;
    248  1.1  macallan }
    249  1.1  macallan 
    250  1.1  macallan static struct of_node *
    251  1.1  macallan of_match_by_parentid(struct of_node *node, const void *ctx)
    252  1.1  macallan {
    253  1.1  macallan 	if (node->of_parent == NULL)
    254  1.1  macallan 		return NULL;
    255  1.1  macallan 	return (node->of_parent->of_nodeid == *(const int *) ctx) ? node : NULL;
    256  1.1  macallan }
    257  1.1  macallan 
    258  1.1  macallan int
    259  1.1  macallan OF_parent(int childid)
    260  1.1  macallan {
    261  1.1  macallan 	struct of_node *child;
    262  1.1  macallan 
    263  1.1  macallan 	if (childid == 0)
    264  1.1  macallan 		return 0;
    265  1.1  macallan 
    266  1.1  macallan 	child = of_tree_walk(&of_root, of_match_by_nodeid, &childid);
    267  1.1  macallan 	if (child == NULL || child->of_parent == NULL)
    268  1.1  macallan 		return 0;
    269  1.1  macallan 	return child->of_parent->of_nodeid;
    270  1.1  macallan }
    271  1.1  macallan 
    272  1.1  macallan int
    273  1.1  macallan OF_child(int parentid)
    274  1.1  macallan {
    275  1.1  macallan 	struct of_node *child;
    276  1.1  macallan 
    277  1.1  macallan 	child = of_tree_walk(&of_root, of_match_by_parentid, &parentid);
    278  1.1  macallan 	if (child == NULL)
    279  1.1  macallan 		return 0;
    280  1.1  macallan 	return child->of_nodeid;
    281  1.1  macallan }
    282  1.1  macallan 
    283  1.1  macallan int
    284  1.1  macallan OF_peer(int peerid)
    285  1.1  macallan {
    286  1.1  macallan 	struct of_node *node, *match;
    287  1.1  macallan 
    288  1.1  macallan 	if (peerid == 0)
    289  1.1  macallan 		return of_root.of_nodeid;
    290  1.1  macallan 
    291  1.1  macallan 	node = of_tree_walk(&of_root, of_match_by_nodeid, &peerid);
    292  1.1  macallan 	if (node == NULL || node->of_parent == NULL)
    293  1.1  macallan 		return 0;
    294  1.1  macallan 
    295  1.1  macallan 	/*
    296  1.1  macallan 	 * The peer should be our next sibling (if one exists).
    297  1.1  macallan 	 */
    298  1.1  macallan 	match = TAILQ_NEXT(node, of_sibling);
    299  1.1  macallan 	return (match != NULL) ? match->of_nodeid : 0;
    300  1.1  macallan }
    301  1.1  macallan 
    302  1.1  macallan int
    303  1.1  macallan OF_finddevice(const char *name)
    304  1.1  macallan {
    305  1.1  macallan #if 0
    306  1.1  macallan 	struct ofiocdesc ofio;
    307  1.1  macallan 
    308  1.1  macallan 	ofio.of_nodeid = 0;
    309  1.1  macallan 	ofio.of_name = argv[optind++];
    310  1.1  macallan 	ofio.of_namelen = strlen(ofio.of_name);
    311  1.1  macallan 	ofio.of_buf = NULL;
    312  1.1  macallan 	ofio.of_buflen = 0;
    313  1.1  macallan 	if (ioctl(of_fd, OFIOCFINDDEVICE, &ofio) < 0)
    314  1.1  macallan 		err(1, "OFIOCFINDDEVICE(%d, \"%s\")", of_fd, ofio.of_name);
    315  1.1  macallan #endif
    316  1.1  macallan 	return 0;
    317  1.1  macallan }
    318  1.1  macallan 
    319  1.1  macallan struct of_prop *
    320  1.1  macallan of_tree_getprop(int nodeid, char *name)
    321  1.1  macallan {
    322  1.1  macallan 	struct of_node *node;
    323  1.1  macallan 	struct of_prop *prop;
    324  1.1  macallan 
    325  1.1  macallan 	if (nodeid == 0)
    326  1.1  macallan 		return 0;
    327  1.1  macallan 
    328  1.1  macallan 	node = of_tree_walk(&of_root, of_match_by_nodeid, &nodeid);
    329  1.1  macallan 	if (node == NULL)
    330  1.1  macallan 		return NULL;
    331  1.1  macallan 
    332  1.1  macallan 	if (name[0] == '\0')
    333  1.1  macallan 		return TAILQ_FIRST(&node->of_properties);
    334  1.1  macallan 
    335  1.1  macallan 	if (!strcmp(name, "name"))
    336  1.1  macallan 		return node->of_name;
    337  1.1  macallan 	if (!strcmp(name, "device_type"))
    338  1.1  macallan 		return node->of_device_type;
    339  1.1  macallan 	if (!strcmp(name, "reg"))
    340  1.1  macallan 		return node->of_reg;
    341  1.1  macallan 
    342  1.1  macallan 	TAILQ_FOREACH(prop, &node->of_properties, prop_sibling) {
    343  1.1  macallan 		if (!strcmp(name, prop->prop_name))
    344  1.1  macallan 			break;
    345  1.1  macallan 	}
    346  1.1  macallan 	return prop;
    347  1.1  macallan }
    348  1.1  macallan 
    349  1.1  macallan int
    350  1.1  macallan OF_getproplen(int nodeid, char *name)
    351  1.1  macallan {
    352  1.1  macallan 	struct of_prop *prop = of_tree_getprop(nodeid, name);
    353  1.1  macallan 	return (prop != NULL) ? prop->prop_length : -1;
    354  1.1  macallan }
    355  1.1  macallan 
    356  1.1  macallan int
    357  1.1  macallan OF_getprop(int nodeid, char *name, void *buf, size_t len)
    358  1.1  macallan {
    359  1.1  macallan 	struct of_prop *prop = of_tree_getprop(nodeid, name);
    360  1.1  macallan 	if (prop == NULL)
    361  1.1  macallan 		return -1;
    362  1.1  macallan 	if (len > prop->prop_length)
    363  1.1  macallan 		len = prop->prop_length;
    364  1.1  macallan 	memcpy(buf, prop->prop_data, len);
    365  1.1  macallan 	return len;
    366  1.1  macallan }
    367  1.1  macallan 
    368  1.1  macallan int
    369  1.1  macallan OF_nextprop(int nodeid, char *name, void *nextname)
    370  1.1  macallan {
    371  1.1  macallan 	struct of_prop *prop = of_tree_getprop(nodeid, name);
    372  1.1  macallan 	if (prop == NULL)
    373  1.1  macallan 		return -1;
    374  1.1  macallan 	if (name[0] != '\0') {
    375  1.1  macallan 		prop = TAILQ_NEXT(prop, prop_sibling);
    376  1.1  macallan 		if (prop == NULL)
    377  1.1  macallan 			return -1;
    378  1.1  macallan 	}
    379  1.1  macallan 	strcpy(nextname, prop->prop_name);
    380  1.1  macallan 	return strlen(prop->prop_name);
    381  1.1  macallan }
    382  1.1  macallan 
    383  1.1  macallan static u_int32_t
    384  1.1  macallan of_decode_int(const u_int8_t *p)
    385  1.1  macallan {
    386  1.1  macallan 	return (p[0] << 24) | (p[1] << 16) | (p[2] << 8) | p[3];
    387  1.1  macallan }
    388  1.1  macallan 
    389  1.1  macallan /*
    390  1.1  macallan  * Now we start the real program
    391  1.1  macallan  */
    392  1.1  macallan 
    393  1.1  macallan int
    394  1.1  macallan main(int argc, char **argv)
    395  1.1  macallan {
    396  1.1  macallan 	u_long of_buf[256];
    397  1.1  macallan 	char device_type[33];
    398  1.1  macallan 	int phandle;
    399  1.1  macallan 	int fd;
    400  1.1  macallan 	int errflag = 0;
    401  1.1  macallan 	int c;
    402  1.1  macallan 	int len;
    403  1.1  macallan #if defined(__sparc__) || defined(__sparc64__)
    404  1.1  macallan 	const char *file = "/dev/openprom";
    405  1.1  macallan #else
    406  1.1  macallan 	const char *file = "/dev/openfirm";
    407  1.1  macallan #endif
    408  1.1  macallan 
    409  1.1  macallan 	while ((c = getopt(argc, argv, "f:lp")) != EOF) {
    410  1.1  macallan 		switch (c) {
    411  1.1  macallan 		case 'l': lflag++; break;
    412  1.1  macallan 		case 'p': pflag++; break;
    413  1.1  macallan 		case 'f': file = optarg; break;
    414  1.1  macallan 		default: errflag++; break;
    415  1.1  macallan 		}
    416  1.1  macallan 	}
    417  1.1  macallan 	if (errflag)
    418  1.1  macallan #if 0
    419  1.1  macallan 		errx(1, "usage: ofdump [-f file] [-l] [-p] [node...]\n");
    420  1.1  macallan #else
    421  1.1  macallan 		errx(1, "usage: ofdump [-f file] [-p] [node...]\n");
    422  1.1  macallan #endif
    423  1.1  macallan 	fd = open(file, O_RDONLY);
    424  1.1  macallan 	if (fd < 0)
    425  1.1  macallan 		err(1, "%s", file);
    426  1.1  macallan 
    427  1.1  macallan 	of_tree_init(fd);
    428  1.1  macallan 	printf("[Caching %lu nodes and %lu properties]\n",
    429  1.1  macallan 		of_node_count, of_prop_count);
    430  1.1  macallan 
    431  1.1  macallan 	if (argc == optind) {
    432  1.1  macallan 		phandle = OF_peer(0);
    433  1.1  macallan 		device_type[0] = '\0';
    434  1.1  macallan 		len = OF_getprop(phandle, "device_type", device_type,
    435  1.1  macallan 		    sizeof(device_type));
    436  1.1  macallan 		if (len <= 0)
    437  1.1  macallan 			len = OF_getprop(phandle, "name", device_type,
    438  1.1  macallan 			    sizeof(device_type));
    439  1.1  macallan 		if (len >= 0)
    440  1.1  macallan 			device_type[len] = '\0';
    441  1.1  macallan 		oflist(phandle, device_type, 0, of_buf, sizeof(of_buf));
    442  1.1  macallan 	} else {
    443  1.1  macallan #if 0
    444  1.1  macallan 		pandle = OF_finddevice(argv[optind++]);
    445  1.1  macallan 
    446  1.1  macallan 		if (argc == optind) {
    447  1.1  macallan 			if (lflag)
    448  1.1  macallan 				oflist(phandle, 0, of_buf, sizeof(of_buf));
    449  1.1  macallan 			else
    450  1.1  macallan 				ofprop(phandle);
    451  1.1  macallan 		} else {
    452  1.1  macallan 			for (; optind < argc; optind++) {
    453  1.1  macallan 				ofgetprop(phandle, argv[optind]);
    454  1.1  macallan 			}
    455  1.1  macallan 		}
    456  1.1  macallan #else
    457  1.1  macallan 		printf("%s: OF_finddevice not yet implemented\n", argv[optind]);
    458  1.1  macallan #endif
    459  1.1  macallan 	}
    460  1.1  macallan 	close(fd);
    461  1.1  macallan 	exit(0);
    462  1.1  macallan }
    463  1.1  macallan 
    464  1.1  macallan static size_t
    465  1.1  macallan ofname(int node, char *buf, size_t buflen)
    466  1.1  macallan {
    467  1.1  macallan 	u_int8_t address_cells_buf[4];
    468  1.1  macallan 	u_int8_t reg_buf[4096];
    469  1.1  macallan 	char name[33];
    470  1.1  macallan 	char device_type[33];
    471  1.1  macallan 	size_t off = 0;
    472  1.1  macallan 	int parent = OF_parent(node);
    473  1.1  macallan 	int reglen;
    474  1.1  macallan 	int reg[sizeof(reg_buf)/sizeof(int)];
    475  1.1  macallan 	int address_cells;
    476  1.1  macallan 	int len;
    477  1.1  macallan 
    478  1.1  macallan 	len = OF_getprop(node, "name", name, sizeof(name));
    479  1.1  macallan 	assert(len > 0);
    480  1.1  macallan 	off += snprintf(buf + off, buflen - off, "/%s", name);
    481  1.1  macallan 
    482  1.1  macallan 	reglen = OF_getprop(node, "reg", reg_buf, sizeof(reg_buf));
    483  1.1  macallan 	if (reglen <= 0)
    484  1.1  macallan 		return off;
    485  1.1  macallan 
    486  1.1  macallan 	len = OF_getprop(parent, "device_type",
    487  1.1  macallan 	    device_type, sizeof(device_type));
    488  1.1  macallan 	if (len <= 0)
    489  1.1  macallan 		len = OF_getprop(parent, "name",
    490  1.1  macallan 		    device_type, sizeof(device_type));
    491  1.1  macallan 	device_type[len] = '\0';
    492  1.1  macallan 
    493  1.1  macallan 	for (;;) {
    494  1.1  macallan 		len = OF_getprop(parent, "#address-cells",
    495  1.1  macallan 		    address_cells_buf, sizeof(address_cells_buf));
    496  1.1  macallan 		if (len >= 0) {
    497  1.1  macallan 			assert(len == 4);
    498  1.1  macallan 			break;
    499  1.1  macallan 		}
    500  1.1  macallan 		parent = OF_parent(parent);
    501  1.1  macallan 		if (parent == 0)
    502  1.1  macallan 			break;
    503  1.1  macallan 	}
    504  1.1  macallan 
    505  1.1  macallan 	if (parent == 0) {
    506  1.1  macallan 
    507  1.1  macallan 		parent = OF_parent(node);
    508  1.1  macallan 		for (;;) {
    509  1.1  macallan 			len = OF_getprop(parent, "#size-cells",
    510  1.1  macallan 			    address_cells_buf, sizeof(address_cells_buf));
    511  1.1  macallan 			if (len >= 0) {
    512  1.1  macallan 				assert(len == 4);
    513  1.1  macallan 				break;
    514  1.1  macallan 			}
    515  1.1  macallan 			parent = OF_parent(parent);
    516  1.1  macallan 			if (parent == 0)
    517  1.1  macallan 				break;
    518  1.1  macallan 		}
    519  1.1  macallan 		assert(parent != 0);
    520  1.1  macallan 	}
    521  1.1  macallan 
    522  1.1  macallan 	off += snprintf(buf + off, buflen - off, "@");
    523  1.1  macallan 
    524  1.1  macallan 	address_cells = of_decode_int(address_cells_buf);
    525  1.1  macallan 	for (len = 0; len < address_cells; len ++)
    526  1.1  macallan 		reg[len] = of_decode_int(&reg_buf[len * 4]);
    527  1.1  macallan 
    528  1.1  macallan 	if (!strcmp(device_type,"pci")) {
    529  1.1  macallan 		off += snprintf(buf + off, buflen - off,
    530  1.1  macallan 		    "%x", (reg[0] >> 11) & 31);
    531  1.1  macallan 		if (reg[0] & 0x700)
    532  1.1  macallan 			off += snprintf(buf + off, buflen - off,
    533  1.1  macallan 			    ",%x", (reg[0] >> 8) & 7);
    534  1.1  macallan 	} else if (!strcmp(device_type,"upa")) {
    535  1.1  macallan 		off += snprintf(buf + off, buflen - off,
    536  1.1  macallan 		    "%x", (reg[0] >> 4) & 63);
    537  1.1  macallan 		for (len = 1; len < address_cells; len++)
    538  1.1  macallan 			off += snprintf(buf + off, buflen - off,
    539  1.1  macallan 			    ",%x", reg[len]);
    540  1.1  macallan #if !defined(__sparc__) && !defined(__sparc64__)
    541  1.1  macallan 	} else if (!strcmp(device_type,"isa")) {
    542  1.1  macallan #endif
    543  1.1  macallan 	} else {
    544  1.1  macallan 		off += snprintf(buf + off, buflen - off, "%x", reg[0]);
    545  1.1  macallan 		for (len = 1; len < address_cells; len++)
    546  1.1  macallan 			off += snprintf(buf + off, buflen - off,
    547  1.1  macallan 			    ",%x", reg[len]);
    548  1.1  macallan 	}
    549  1.1  macallan 	return off;
    550  1.1  macallan }
    551  1.1  macallan 
    552  1.1  macallan static size_t
    553  1.1  macallan offullname2(int node, char *buf, size_t len)
    554  1.1  macallan {
    555  1.1  macallan 	size_t off;
    556  1.1  macallan 	int parent = OF_parent(node);
    557  1.1  macallan 	if (parent == 0)
    558  1.1  macallan 		return 0;
    559  1.1  macallan 
    560  1.1  macallan 	off = offullname2(parent, buf, len);
    561  1.1  macallan 	off += ofname(node, buf + off, len - off);
    562  1.1  macallan 	return off;
    563  1.1  macallan }
    564  1.1  macallan 
    565  1.1  macallan static size_t
    566  1.1  macallan offullname(int node, char *buf, size_t len)
    567  1.1  macallan {
    568  1.1  macallan 	if (node == OF_peer(0)) {
    569  1.1  macallan 		size_t off = snprintf(buf, len, "/");
    570  1.1  macallan 		off += OF_getprop(node, "name", buf + off, len - off);
    571  1.1  macallan 		return off;
    572  1.1  macallan 	}
    573  1.1  macallan 	return offullname2(node, buf, len);
    574  1.1  macallan }
    575  1.1  macallan 
    576  1.1  macallan static void
    577  1.1  macallan oflist(int node, const char *parent_device_type, int depth,
    578  1.1  macallan 	void *of_buf, size_t of_buflen)
    579  1.1  macallan {
    580  1.1  macallan 	int len;
    581  1.1  macallan 	while (node != 0) {
    582  1.1  macallan 		int child;
    583  1.1  macallan 		if (pflag == 0) {
    584  1.1  macallan 			len = ofname(node, of_buf, of_buflen-1);
    585  1.1  macallan 			printf("%08x: %*s%s", node, depth * 2, "",
    586  1.1  macallan 			    (char *) of_buf);
    587  1.1  macallan 		} else {
    588  1.1  macallan 			len = offullname(node, of_buf, of_buflen-1);
    589  1.1  macallan 			printf("%08x: %s", node, (char *) of_buf);
    590  1.1  macallan 		}
    591  1.1  macallan 		putchar('\n');
    592  1.1  macallan 		if (pflag) {
    593  1.1  macallan 			putchar('\n');
    594  1.1  macallan 			ofprop(node);
    595  1.1  macallan 			puts("\n----------------------------------------"
    596  1.1  macallan 			    "----------------------------------------\n\n");
    597  1.1  macallan 		}
    598  1.1  macallan 		child = OF_child(node);
    599  1.1  macallan 		if (child != -1 && child != 0) {
    600  1.1  macallan 			char device_type[33];
    601  1.1  macallan 			len = OF_getprop(node, "device_type",
    602  1.1  macallan 			    device_type, sizeof(device_type));
    603  1.1  macallan 			if (len <= 0)
    604  1.1  macallan 				len = OF_getprop(node, "name",
    605  1.1  macallan 				    device_type, sizeof(device_type));
    606  1.1  macallan 			if (len >= 0)
    607  1.1  macallan 				device_type[len] = '\0';
    608  1.1  macallan 			depth++;
    609  1.1  macallan 			oflist(child, device_type, depth, of_buf, of_buflen);
    610  1.1  macallan 			depth--;
    611  1.1  macallan 		}
    612  1.1  macallan 		if (depth == 0)
    613  1.1  macallan 			break;
    614  1.1  macallan 		node = OF_peer(node);
    615  1.1  macallan 	}
    616  1.1  macallan }
    617  1.1  macallan 
    618  1.1  macallan static void
    619  1.1  macallan print_line(const u_int8_t *buf, size_t off, size_t len)
    620  1.1  macallan {
    621  1.1  macallan 	if (len - off > 16)
    622  1.1  macallan 		len = off + 16;
    623  1.1  macallan 
    624  1.1  macallan 	for (; off < ((len + 15) & ~15); off++) {
    625  1.1  macallan 		if (off > 0) {
    626  1.1  macallan 			if ((off & 15) == 0)
    627  1.1  macallan 				printf("%12s%04lx:%7s", "",
    628  1.1  macallan 				    (unsigned long int) off, "");
    629  1.1  macallan 			else if ((off & 3) == 0)
    630  1.1  macallan 				putchar(' ');
    631  1.1  macallan 		}
    632  1.1  macallan 		if (off < len)
    633  1.1  macallan 			printf("%02x", buf[off]);
    634  1.1  macallan #if 0
    635  1.1  macallan 		else if (off >= ((len + 3) & ~3))
    636  1.1  macallan 			printf("  ");
    637  1.1  macallan #endif
    638  1.1  macallan 		else
    639  1.1  macallan 			printf("..");
    640  1.1  macallan 	}
    641  1.1  macallan }
    642  1.1  macallan 
    643  1.1  macallan static void
    644  1.1  macallan default_format(int node, const u_int8_t *buf, size_t len)
    645  1.1  macallan {
    646  1.1  macallan 	size_t off = 0;
    647  1.1  macallan 	while (off < len) {
    648  1.1  macallan 		size_t end;
    649  1.1  macallan 		print_line(buf, off, len);
    650  1.1  macallan 		printf("   ");	/* 24 + 32 + 3 = 59, so +3 makes 62 */
    651  1.1  macallan 		end = len;
    652  1.1  macallan 		if (end > off + 16)
    653  1.1  macallan 			end = off + 16;
    654  1.1  macallan 		for (; off < end; off++) {
    655  1.1  macallan 			char ch = buf[off];
    656  1.1  macallan 			if (isascii(ch) &&
    657  1.1  macallan 			    (isalnum((int)ch) || ispunct((int)ch) || ch == ' '))
    658  1.1  macallan 				putchar(ch);
    659  1.1  macallan 			else
    660  1.1  macallan 				putchar('.');
    661  1.1  macallan 		}
    662  1.1  macallan 		putchar('\n');
    663  1.1  macallan 	}
    664  1.1  macallan }
    665  1.1  macallan 
    666  1.1  macallan static void
    667  1.1  macallan reg_format(int node, const u_int8_t *buf, size_t len)
    668  1.1  macallan {
    669  1.1  macallan 	/* parent = OF_parent(node); */
    670  1.1  macallan 	default_format(node, buf, len);
    671  1.1  macallan }
    672  1.1  macallan 
    673  1.1  macallan static void
    674  1.1  macallan frequency_format(int node, const u_int8_t *buf, size_t len)
    675  1.1  macallan {
    676  1.1  macallan 	if (len == 4) {
    677  1.1  macallan 		u_int32_t freq = of_decode_int(buf);
    678  1.1  macallan 		u_int32_t divisor, whole, frac;
    679  1.1  macallan 		const char *units = "";
    680  1.1  macallan 		print_line(buf, 0, len);
    681  1.1  macallan 		for (divisor = 1000000000; divisor > 1; divisor /= 1000) {
    682  1.1  macallan 			if (freq >= divisor)
    683  1.1  macallan 				break;
    684  1.1  macallan 		}
    685  1.1  macallan 		whole = freq / divisor;
    686  1.1  macallan 		if (divisor == 1)
    687  1.1  macallan 			frac = 0;
    688  1.1  macallan 		else
    689  1.1  macallan 			frac = (freq / (divisor / 1000)) % 1000;
    690  1.1  macallan 
    691  1.1  macallan 		switch (divisor) {
    692  1.1  macallan 		case 1000000000: units = "GHz"; break;
    693  1.1  macallan 		case    1000000: units = "MHz"; break;
    694  1.1  macallan 		case       1000: units = "KHz"; break;
    695  1.1  macallan 		case          1: units =  "Hz"; break;
    696  1.1  macallan 		}
    697  1.1  macallan 		if (frac > 0)
    698  1.1  macallan 			printf("   %u.%03u%s\n", whole, frac, units);
    699  1.1  macallan 		else
    700  1.1  macallan 			printf("   %u%s\n", whole, units);
    701  1.1  macallan 	} else
    702  1.1  macallan 		default_format(node, buf, len);
    703  1.1  macallan }
    704  1.1  macallan 
    705  1.1  macallan static void
    706  1.1  macallan size_format(int node, const u_int8_t *buf, size_t len)
    707  1.1  macallan {
    708  1.1  macallan 	if (len == 4) {
    709  1.1  macallan 		u_int32_t freq = of_decode_int(buf);
    710  1.1  macallan 		u_int32_t divisor, whole, frac;
    711  1.1  macallan 		const char *units = "";
    712  1.1  macallan 		print_line(buf, 0, len);
    713  1.1  macallan 		for (divisor = 0x40000000; divisor > 1; divisor >>= 10) {
    714  1.1  macallan 			if (freq >= divisor)
    715  1.1  macallan 				break;
    716  1.1  macallan 		}
    717  1.1  macallan 		whole = freq / divisor;
    718  1.1  macallan 		if (divisor == 1)
    719  1.1  macallan 			frac = 0;
    720  1.1  macallan 		else
    721  1.1  macallan 			frac = (freq / (divisor >> 10)) & 1023;
    722  1.1  macallan 
    723  1.1  macallan 		switch (divisor) {
    724  1.1  macallan 		case 0x40000000: units = "G"; break;
    725  1.1  macallan 		case   0x100000: units = "M"; break;
    726  1.1  macallan 		case      0x400: units = "K"; break;
    727  1.1  macallan 		case          1: units =  ""; break;
    728  1.1  macallan 		}
    729  1.1  macallan 		if (frac > 0)
    730  1.1  macallan 			printf("   %3u.%03u%s\n", whole, frac, units);
    731  1.1  macallan 		else
    732  1.1  macallan 			printf("   %3u%s\n", whole, units);
    733  1.1  macallan 	} else
    734  1.1  macallan 		default_format(node, buf, len);
    735  1.1  macallan }
    736  1.1  macallan 
    737  1.1  macallan static void
    738  1.1  macallan string_format(int node, const u_int8_t *buf, size_t len)
    739  1.1  macallan {
    740  1.1  macallan 	size_t off = 0;
    741  1.1  macallan 	int first_line = 1;
    742  1.1  macallan 	while (off < len) {
    743  1.1  macallan 		size_t string_len = 0;
    744  1.1  macallan 		int leading = 1;
    745  1.1  macallan 		for (; off + string_len < len; string_len++) {
    746  1.1  macallan 			if (buf[off+string_len] == '\0') {
    747  1.1  macallan 				string_len++;
    748  1.1  macallan 				break;
    749  1.1  macallan 			}
    750  1.1  macallan 		}
    751  1.1  macallan 		while (string_len > 0) {
    752  1.1  macallan 			size_t line_len = string_len;
    753  1.1  macallan 			if (line_len > 16)
    754  1.1  macallan 				line_len = 16;
    755  1.1  macallan 			if (!first_line)
    756  1.1  macallan 				printf("%12s%04lx:%7s", "",
    757  1.1  macallan 				    (unsigned long int) off, "");
    758  1.1  macallan 			print_line(buf + off, 0, line_len);
    759  1.1  macallan 			printf("   ");
    760  1.1  macallan 			if (leading)
    761  1.1  macallan 				putchar('"');
    762  1.1  macallan 			first_line = 0;
    763  1.1  macallan 			leading = 0;
    764  1.1  macallan 			string_len -= line_len;
    765  1.1  macallan 			for (; line_len > 0; line_len--, off++) {
    766  1.1  macallan 				if (buf[off] != '\0')
    767  1.1  macallan 					putchar(buf[off]);
    768  1.1  macallan 			}
    769  1.1  macallan 			if (string_len == 0)
    770  1.1  macallan 				putchar('"');
    771  1.1  macallan 			putchar('\n');
    772  1.1  macallan 		}
    773  1.1  macallan 	}
    774  1.1  macallan }
    775  1.1  macallan 
    776  1.1  macallan static const struct {
    777  1.1  macallan 	const char *prop_name;
    778  1.1  macallan 	void (*prop_format)(int, const u_int8_t *, size_t);
    779  1.1  macallan } formatters[] = {
    780  1.1  macallan 	{ "reg", reg_format },
    781  1.1  macallan #if 0
    782  1.1  macallan 	{ "assigned-addresses", assigned_addresses_format },
    783  1.1  macallan 	{ "ranges", ranges_format },
    784  1.1  macallan 	{ "interrupt-map", interrup_map_format },
    785  1.1  macallan 	{ "interrupt", interrupt_format },
    786  1.1  macallan #endif
    787  1.1  macallan 	{ "model", string_format },
    788  1.1  macallan 	{ "name", string_format },
    789  1.1  macallan 	{ "device_type", string_format },
    790  1.1  macallan 	{ "compatible", string_format },
    791  1.1  macallan 	{ "*frequency", frequency_format },
    792  1.1  macallan 	{ "*-size", size_format },
    793  1.1  macallan 	{ "*-cells", size_format },
    794  1.1  macallan 	{ "*-entries", size_format },
    795  1.1  macallan 	{ "*-associativity", size_format },
    796  1.1  macallan 	{ NULL, default_format }
    797  1.1  macallan };
    798  1.1  macallan 
    799  1.1  macallan static void
    800  1.1  macallan ofgetprop(int node, char *name)
    801  1.1  macallan {
    802  1.1  macallan 	u_int8_t of_buf[4097];
    803  1.1  macallan 	int len;
    804  1.1  macallan 	int i;
    805  1.1  macallan 
    806  1.1  macallan 	len = OF_getprop(node, name, of_buf, sizeof(of_buf) - 1);
    807  1.1  macallan 	if (len < 0)
    808  1.1  macallan 		return;
    809  1.1  macallan 	of_buf[len] = '\0';
    810  1.1  macallan 	printf("%-24s", name);
    811  1.1  macallan 	if (len == 0) {
    812  1.1  macallan 		putchar('\n');
    813  1.1  macallan 		return;
    814  1.1  macallan 	}
    815  1.1  macallan 	if (strlen(name) >= 24)
    816  1.1  macallan 		printf("\n%24s", "");
    817  1.1  macallan 
    818  1.1  macallan 	for (i = 0; formatters[i].prop_name != NULL; i++) {
    819  1.1  macallan 		if (formatters[i].prop_name[0] == '*') {
    820  1.1  macallan 			if (strstr(name, &formatters[i].prop_name[1]) != NULL) {
    821  1.1  macallan 				(*formatters[i].prop_format)(node, of_buf, len);
    822  1.1  macallan 				return;
    823  1.1  macallan 			}
    824  1.1  macallan 			continue;
    825  1.1  macallan 		}
    826  1.1  macallan 		if (strcmp(name, formatters[i].prop_name) == 0) {
    827  1.1  macallan 			(*formatters[i].prop_format)(node, of_buf, len);
    828  1.1  macallan 			return;
    829  1.1  macallan 		}
    830  1.1  macallan 	}
    831  1.1  macallan 	(*formatters[i].prop_format)(node, of_buf, len);
    832  1.1  macallan }
    833  1.1  macallan 
    834  1.1  macallan static void
    835  1.1  macallan ofprop(int node)
    836  1.1  macallan {
    837  1.1  macallan 	char namebuf[33];
    838  1.1  macallan 	char newnamebuf[33];
    839  1.1  macallan 	int len;
    840  1.1  macallan 
    841  1.1  macallan 	namebuf[0] = '\0';
    842  1.1  macallan 
    843  1.1  macallan 	for (;;) {
    844  1.1  macallan 		len = OF_nextprop(node, namebuf, newnamebuf);
    845  1.1  macallan 		if (len <= 0)
    846  1.1  macallan 			break;
    847  1.1  macallan 
    848  1.1  macallan 		newnamebuf[len] = '\0';
    849  1.1  macallan 		strcpy(namebuf, newnamebuf);
    850  1.1  macallan 		ofgetprop(node, newnamebuf);
    851  1.1  macallan 	}
    852  1.1  macallan }
    853  1.1  macallan #if 0
    854  1.1  macallan static int
    855  1.1  macallan isstrprint(const char *str, size_t len, int ignorenulls)
    856  1.1  macallan {
    857  1.1  macallan 	if (*str == '\0')
    858  1.1  macallan 		return 0;
    859  1.1  macallan 	for (; len-- > 0; str++) {
    860  1.1  macallan 		if (*str == '\0' && len > 0 && str[1] == '\0')
    861  1.1  macallan 			return 0;
    862  1.1  macallan 		if (len == 0 && *str == '\0')
    863  1.1  macallan 			return 1;
    864  1.1  macallan 		if (ignorenulls) {
    865  1.1  macallan 			if (*str == '\0')
    866  1.1  macallan 				continue;
    867  1.1  macallan 			if (isalnum(*str) || ispunct(*str) || *str == ' ')
    868  1.1  macallan 				continue;
    869  1.1  macallan 			return 0;
    870  1.1  macallan 		}
    871  1.1  macallan 		if (!isprint(*str))
    872  1.1  macallan 			return 0;
    873  1.1  macallan 	}
    874  1.1  macallan 	return 1;
    875  1.1  macallan }
    876  1.1  macallan #endif
    877