Home | History | Annotate | Line # | Download | only in ofctl
ofctl.c revision 1.7
      1  1.7      jmmv /*	$NetBSD: ofctl.c,v 1.7 2007/08/05 13:52:44 jmmv Exp $	*/
      2  1.1  macallan 
      3  1.1  macallan /*-
      4  1.7      jmmv  * Copyright (c) 2006, 2007 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.7      jmmv #include <sys/cdefs.h>
     36  1.7      jmmv 
     37  1.7      jmmv #ifndef lint
     38  1.7      jmmv __COPYRIGHT("@(#) Copyright (c) 2006, 2007\n"
     39  1.7      jmmv "The NetBSD Foundation, Inc.  All rights reserved.\n");
     40  1.7      jmmv __RCSID("$NetBSD: ofctl.c,v 1.7 2007/08/05 13:52:44 jmmv Exp $");
     41  1.7      jmmv #endif /* not lint */
     42  1.7      jmmv 
     43  1.1  macallan #include <stdio.h>
     44  1.1  macallan #include <stdlib.h>
     45  1.1  macallan #include <unistd.h>
     46  1.1  macallan #include <errno.h>
     47  1.1  macallan #include <ctype.h>
     48  1.1  macallan #include <string.h>
     49  1.1  macallan #include <assert.h>
     50  1.1  macallan #include <err.h>
     51  1.1  macallan #include <sys/types.h>
     52  1.1  macallan #include <sys/ioctl.h>
     53  1.1  macallan #include <sys/file.h>
     54  1.1  macallan #include <sys/queue.h>
     55  1.1  macallan #include <dev/ofw/openfirmio.h>
     56  1.1  macallan 
     57  1.4      matt #include <prop/proplib.h>
     58  1.4      matt 
     59  1.1  macallan static void oflist(int, const char *, int, void *, size_t);
     60  1.1  macallan static void ofprop(int);
     61  1.1  macallan static void ofgetprop(int, char *);
     62  1.1  macallan #if 0
     63  1.1  macallan static int isstrprint(const char *, size_t, int);
     64  1.1  macallan #endif
     65  1.1  macallan 
     66  1.1  macallan static int lflag;
     67  1.1  macallan static int pflag;
     68  1.1  macallan 
     69  1.1  macallan struct of_node {
     70  1.1  macallan 	TAILQ_ENTRY(of_node) of_sibling;
     71  1.1  macallan 	TAILQ_HEAD(,of_node) of_children;
     72  1.1  macallan 	TAILQ_HEAD(,of_prop) of_properties;
     73  1.1  macallan 	struct of_node *of_parent;
     74  1.1  macallan 	struct of_prop *of_name;
     75  1.1  macallan 	struct of_prop *of_device_type;
     76  1.1  macallan 	struct of_prop *of_reg;
     77  1.1  macallan 	int of_nodeid;
     78  1.1  macallan };
     79  1.1  macallan 
     80  1.1  macallan struct of_prop {
     81  1.1  macallan 	TAILQ_ENTRY(of_prop) prop_sibling;
     82  1.1  macallan 	char *prop_name;
     83  1.1  macallan 	u_int8_t *prop_data;
     84  1.1  macallan 	size_t prop_length;
     85  1.1  macallan 	size_t prop_namelen;
     86  1.1  macallan };
     87  1.1  macallan 
     88  1.1  macallan struct of_node of_root;
     89  1.1  macallan unsigned long of_node_count;
     90  1.1  macallan unsigned long of_prop_count;
     91  1.4      matt prop_dictionary_t of_proplib;
     92  1.1  macallan 
     93  1.1  macallan int OF_parent(int);
     94  1.1  macallan int OF_child(int);
     95  1.1  macallan int OF_peer(int);
     96  1.1  macallan int OF_finddevice(const char *);
     97  1.1  macallan int OF_getproplen(int, char *);
     98  1.1  macallan int OF_getprop(int, char *, void *, size_t);
     99  1.1  macallan int OF_nextprop(int, char *, void *);
    100  1.1  macallan 
    101  1.1  macallan struct of_prop *of_tree_getprop(int, char *);
    102  1.1  macallan 
    103  1.1  macallan static void
    104  1.4      matt of_tree_mkprop(struct of_node *node, prop_dictionary_t propdict,
    105  1.4      matt     prop_dictionary_keysym_t key)
    106  1.1  macallan {
    107  1.1  macallan 	struct of_prop *prop;
    108  1.4      matt 	prop_data_t obj;
    109  1.4      matt 	const char *name;
    110  1.4      matt 
    111  1.4      matt 	name = prop_dictionary_keysym_cstring_nocopy(key);
    112  1.4      matt 	obj = prop_dictionary_get_keysym(propdict, key);
    113  1.1  macallan 
    114  1.1  macallan 	prop = malloc(sizeof(*prop) + strlen(name) + 1);
    115  1.1  macallan 	if (prop == NULL)
    116  1.4      matt 		err(1, "malloc(%zu)", sizeof(*prop) + strlen(name) + 1);
    117  1.1  macallan 
    118  1.1  macallan 	memset(prop, 0, sizeof(*prop));
    119  1.1  macallan 	prop->prop_name = (char *) (prop + 1);
    120  1.1  macallan 	prop->prop_namelen = strlen(name);
    121  1.1  macallan 	memcpy(prop->prop_name, name, prop->prop_namelen+1);
    122  1.1  macallan 	TAILQ_INSERT_TAIL(&node->of_properties, prop, prop_sibling);
    123  1.1  macallan 
    124  1.1  macallan 	if (!strcmp(name, "name"))
    125  1.1  macallan 		node->of_name = prop;
    126  1.1  macallan 	else if (!strcmp(name, "device_type"))
    127  1.1  macallan 		node->of_device_type = prop;
    128  1.1  macallan 	else if (!strcmp(name, "reg"))
    129  1.1  macallan 		node->of_reg = prop;
    130  1.1  macallan 
    131  1.1  macallan 	of_prop_count++;
    132  1.1  macallan 
    133  1.4      matt 	prop->prop_length = prop_data_size(obj);
    134  1.4      matt 	if (prop->prop_length)
    135  1.4      matt 		prop->prop_data = prop_data_data(obj);
    136  1.1  macallan }
    137  1.1  macallan 
    138  1.1  macallan static struct of_node *
    139  1.4      matt of_tree_mknode(struct of_node *parent)
    140  1.1  macallan {
    141  1.1  macallan 	struct of_node *newnode;
    142  1.1  macallan 	newnode = malloc(sizeof(*newnode));
    143  1.1  macallan 	if (newnode == NULL)
    144  1.4      matt 		err(1, "malloc(%zu)", sizeof(*newnode));
    145  1.1  macallan 
    146  1.1  macallan 	of_node_count++;
    147  1.1  macallan 
    148  1.1  macallan 	memset(newnode, 0, sizeof(*newnode));
    149  1.1  macallan 	TAILQ_INIT(&newnode->of_children);
    150  1.1  macallan 	TAILQ_INIT(&newnode->of_properties);
    151  1.1  macallan 	newnode->of_parent = parent;
    152  1.1  macallan 
    153  1.1  macallan 	TAILQ_INSERT_TAIL(&parent->of_children, newnode, of_sibling);
    154  1.1  macallan 
    155  1.1  macallan 	return newnode;
    156  1.1  macallan }
    157  1.1  macallan 
    158  1.1  macallan static void
    159  1.4      matt of_tree_fill(prop_dictionary_t dict, struct of_node *node)
    160  1.4      matt {
    161  1.4      matt 	prop_dictionary_t propdict;
    162  1.4      matt 	prop_array_t propkeys;
    163  1.4      matt 	prop_array_t children;
    164  1.4      matt 	unsigned int i, count;
    165  1.4      matt 
    166  1.4      matt 	node->of_nodeid = prop_number_unsigned_integer_value(
    167  1.4      matt 	    prop_dictionary_get(dict, "node"));
    168  1.4      matt 
    169  1.4      matt 	propdict = prop_dictionary_get(dict, "properties");
    170  1.4      matt 	propkeys = prop_dictionary_all_keys(propdict);
    171  1.4      matt 	count = prop_array_count(propkeys);
    172  1.4      matt 
    173  1.4      matt 	for (i = 0; i < count; i++)
    174  1.4      matt 		of_tree_mkprop(node, propdict, prop_array_get(propkeys, i));
    175  1.4      matt 
    176  1.4      matt 	children = prop_dictionary_get(dict, "children");
    177  1.4      matt 	if (children) {
    178  1.4      matt 		count = prop_array_count(children);
    179  1.4      matt 
    180  1.4      matt 		for (i = 0; i < count; i++) {
    181  1.4      matt 			of_tree_fill(
    182  1.4      matt 			    prop_array_get(children, i),
    183  1.4      matt 			    of_tree_mknode(node));
    184  1.4      matt 		}
    185  1.4      matt 	}
    186  1.4      matt }
    187  1.4      matt 
    188  1.4      matt static void
    189  1.4      matt of_tree_init(prop_dictionary_t dict)
    190  1.4      matt {
    191  1.4      matt 	/*
    192  1.4      matt 	 * Initialize the root node of the OFW tree.
    193  1.4      matt 	 */
    194  1.4      matt 	TAILQ_INIT(&of_root.of_children);
    195  1.4      matt 	TAILQ_INIT(&of_root.of_properties);
    196  1.4      matt 
    197  1.4      matt 	of_tree_fill(dict, &of_root);
    198  1.4      matt }
    199  1.4      matt 
    200  1.4      matt static prop_object_t
    201  1.4      matt of_proplib_mkprop(int fd, int nodeid, char *name)
    202  1.1  macallan {
    203  1.4      matt 	struct ofiocdesc ofio;
    204  1.4      matt 	prop_object_t obj;
    205  1.4      matt 
    206  1.4      matt 	ofio.of_nodeid = nodeid;
    207  1.4      matt 	ofio.of_name = name;
    208  1.4      matt 	ofio.of_namelen = strlen(name);
    209  1.4      matt 	ofio.of_buf = NULL;
    210  1.4      matt 	ofio.of_buflen = 32;
    211  1.4      matt 
    212  1.4      matt    again:
    213  1.4      matt 	if (ofio.of_buf != NULL)
    214  1.4      matt 		free(ofio.of_buf);
    215  1.4      matt 	ofio.of_buf = malloc(ofio.of_buflen);
    216  1.4      matt 	if (ofio.of_buf == NULL)
    217  1.5       rjs 		err(1, "malloc(%d)", ofio.of_buflen);
    218  1.4      matt 	if (ioctl(fd, OFIOCGET, &ofio) < 0) {
    219  1.4      matt 		if (errno == ENOMEM) {
    220  1.4      matt 			ofio.of_buflen *= 2;
    221  1.4      matt 			goto again;
    222  1.4      matt 		}
    223  1.4      matt 		warn("OFIOCGET(%d, \"%s\")", fd, name);
    224  1.4      matt 		free(ofio.of_buf);
    225  1.4      matt 		return NULL;
    226  1.4      matt 	}
    227  1.4      matt 	obj = prop_data_create_data(ofio.of_buf, ofio.of_buflen);
    228  1.4      matt 	free(ofio.of_buf);
    229  1.4      matt 	return obj;
    230  1.4      matt }
    231  1.4      matt 
    232  1.4      matt static prop_dictionary_t
    233  1.4      matt of_proplib_tree_fill(int fd, int nodeid)
    234  1.4      matt {
    235  1.4      matt 	int childid = nodeid;
    236  1.1  macallan 	struct ofiocdesc ofio;
    237  1.1  macallan 	char namebuf[33];
    238  1.1  macallan 	char newnamebuf[33];
    239  1.4      matt 	prop_array_t children;
    240  1.4      matt 	prop_dictionary_t dict, propdict;
    241  1.4      matt 	prop_object_t obj;
    242  1.1  macallan 
    243  1.4      matt 	ofio.of_nodeid = nodeid;
    244  1.1  macallan 	ofio.of_name = namebuf;
    245  1.1  macallan 	ofio.of_namelen = 1;
    246  1.1  macallan 	ofio.of_buf = newnamebuf;
    247  1.1  macallan 
    248  1.1  macallan 	namebuf[0] = '\0';
    249  1.1  macallan 
    250  1.4      matt 	dict = prop_dictionary_create();
    251  1.4      matt 	prop_dictionary_set(dict, "node",
    252  1.4      matt 	    prop_number_create_unsigned_integer(nodeid));
    253  1.4      matt 
    254  1.4      matt 	propdict = prop_dictionary_create();
    255  1.1  macallan 	for (;;) {
    256  1.1  macallan 		ofio.of_buflen = sizeof(newnamebuf);
    257  1.1  macallan 
    258  1.1  macallan 		if (ioctl(fd, OFIOCNEXTPROP, &ofio) < 0) {
    259  1.1  macallan 			if (errno == ENOENT)
    260  1.1  macallan 				break;
    261  1.1  macallan 			err(1, "OFIOCNEXTPROP(%d, %#x, \"%s\")", fd,
    262  1.1  macallan 			    ofio.of_nodeid, ofio.of_name);
    263  1.1  macallan 		}
    264  1.1  macallan 
    265  1.1  macallan 		ofio.of_namelen = ofio.of_buflen;
    266  1.1  macallan 		if (ofio.of_namelen == 0)
    267  1.1  macallan 			break;
    268  1.1  macallan 		newnamebuf[ofio.of_buflen] = '\0';
    269  1.1  macallan 		strcpy(namebuf, newnamebuf);
    270  1.4      matt 		obj = of_proplib_mkprop(fd, nodeid, namebuf);
    271  1.4      matt 		if (obj)
    272  1.4      matt 			prop_dictionary_set(propdict, namebuf, obj);
    273  1.1  macallan 	}
    274  1.4      matt 	prop_dictionary_set(dict, "properties", propdict);
    275  1.1  macallan 
    276  1.1  macallan 	if (ioctl(fd, OFIOCGETCHILD, &childid) < 0)
    277  1.1  macallan 		err(1, "OFIOCGETCHILD(%d, %#x)", fd, childid);
    278  1.1  macallan 
    279  1.4      matt 	children = NULL;
    280  1.1  macallan 	while (childid != 0) {
    281  1.4      matt 		if (children == NULL)
    282  1.4      matt 			children = prop_array_create();
    283  1.4      matt 		prop_array_add(children, of_proplib_tree_fill(fd, childid));
    284  1.1  macallan 		if (ioctl(fd, OFIOCGETNEXT, &childid) < 0)
    285  1.1  macallan 			err(1, "OFIOCGETNEXT(%d, %#x)", fd, childid);
    286  1.1  macallan 	}
    287  1.4      matt 	if (children != NULL) {
    288  1.4      matt 		prop_array_make_immutable(children);
    289  1.4      matt 		prop_dictionary_set(dict, "children", children);
    290  1.4      matt 	}
    291  1.1  macallan 
    292  1.4      matt 	return dict;
    293  1.1  macallan }
    294  1.1  macallan 
    295  1.4      matt static prop_dictionary_t
    296  1.4      matt of_proplib_init(const char *file)
    297  1.1  macallan {
    298  1.4      matt 	prop_dictionary_t dict;
    299  1.1  macallan 	int rootid = 0;
    300  1.4      matt 	int fd;
    301  1.4      matt 
    302  1.4      matt 	fd = open(file, O_RDONLY);
    303  1.4      matt 	if (fd < 0)
    304  1.4      matt 		err(1, "%s", file);
    305  1.1  macallan 
    306  1.1  macallan 	if (ioctl(fd, OFIOCGETNEXT, &rootid) < 0)
    307  1.1  macallan 		err(1, "OFIOCGETNEXT(%d, %#x)", fd, rootid);
    308  1.1  macallan 
    309  1.4      matt 	dict = of_proplib_tree_fill(fd, rootid);
    310  1.4      matt 	close(fd);
    311  1.4      matt 	return dict;
    312  1.1  macallan }
    313  1.1  macallan 
    314  1.1  macallan static struct of_node *
    315  1.1  macallan of_tree_walk(struct of_node *node,
    316  1.1  macallan 	struct of_node *(*fn)(struct of_node *, const void *),
    317  1.1  macallan 	const void *ctx)
    318  1.1  macallan {
    319  1.1  macallan 	struct of_node *child, *match;
    320  1.1  macallan 
    321  1.1  macallan 	if ((match = (*fn)(node, ctx)) != NULL)
    322  1.1  macallan 		return match;
    323  1.1  macallan 
    324  1.1  macallan 	TAILQ_FOREACH(child, &node->of_children, of_sibling) {
    325  1.1  macallan 		if ((match = of_tree_walk(child, fn, ctx)) != NULL)
    326  1.1  macallan 			return match;
    327  1.1  macallan 	}
    328  1.1  macallan 	return NULL;
    329  1.1  macallan }
    330  1.1  macallan 
    331  1.1  macallan static struct of_node *
    332  1.1  macallan of_match_by_nodeid(struct of_node *node, const void *ctx)
    333  1.1  macallan {
    334  1.1  macallan 	return (node->of_nodeid == *(const int *) ctx) ? node : NULL;
    335  1.1  macallan }
    336  1.1  macallan 
    337  1.1  macallan static struct of_node *
    338  1.1  macallan of_match_by_parentid(struct of_node *node, const void *ctx)
    339  1.1  macallan {
    340  1.1  macallan 	if (node->of_parent == NULL)
    341  1.1  macallan 		return NULL;
    342  1.1  macallan 	return (node->of_parent->of_nodeid == *(const int *) ctx) ? node : NULL;
    343  1.1  macallan }
    344  1.1  macallan 
    345  1.1  macallan int
    346  1.1  macallan OF_parent(int childid)
    347  1.1  macallan {
    348  1.1  macallan 	struct of_node *child;
    349  1.1  macallan 
    350  1.1  macallan 	if (childid == 0)
    351  1.1  macallan 		return 0;
    352  1.1  macallan 
    353  1.1  macallan 	child = of_tree_walk(&of_root, of_match_by_nodeid, &childid);
    354  1.1  macallan 	if (child == NULL || child->of_parent == NULL)
    355  1.1  macallan 		return 0;
    356  1.1  macallan 	return child->of_parent->of_nodeid;
    357  1.1  macallan }
    358  1.1  macallan 
    359  1.1  macallan int
    360  1.1  macallan OF_child(int parentid)
    361  1.1  macallan {
    362  1.1  macallan 	struct of_node *child;
    363  1.1  macallan 
    364  1.1  macallan 	child = of_tree_walk(&of_root, of_match_by_parentid, &parentid);
    365  1.1  macallan 	if (child == NULL)
    366  1.1  macallan 		return 0;
    367  1.1  macallan 	return child->of_nodeid;
    368  1.1  macallan }
    369  1.1  macallan 
    370  1.1  macallan int
    371  1.1  macallan OF_peer(int peerid)
    372  1.1  macallan {
    373  1.1  macallan 	struct of_node *node, *match;
    374  1.1  macallan 
    375  1.1  macallan 	if (peerid == 0)
    376  1.1  macallan 		return of_root.of_nodeid;
    377  1.1  macallan 
    378  1.1  macallan 	node = of_tree_walk(&of_root, of_match_by_nodeid, &peerid);
    379  1.1  macallan 	if (node == NULL || node->of_parent == NULL)
    380  1.1  macallan 		return 0;
    381  1.1  macallan 
    382  1.1  macallan 	/*
    383  1.1  macallan 	 * The peer should be our next sibling (if one exists).
    384  1.1  macallan 	 */
    385  1.1  macallan 	match = TAILQ_NEXT(node, of_sibling);
    386  1.1  macallan 	return (match != NULL) ? match->of_nodeid : 0;
    387  1.1  macallan }
    388  1.1  macallan 
    389  1.1  macallan int
    390  1.1  macallan OF_finddevice(const char *name)
    391  1.1  macallan {
    392  1.1  macallan #if 0
    393  1.1  macallan 	struct ofiocdesc ofio;
    394  1.1  macallan 
    395  1.1  macallan 	ofio.of_nodeid = 0;
    396  1.1  macallan 	ofio.of_name = argv[optind++];
    397  1.1  macallan 	ofio.of_namelen = strlen(ofio.of_name);
    398  1.1  macallan 	ofio.of_buf = NULL;
    399  1.1  macallan 	ofio.of_buflen = 0;
    400  1.1  macallan 	if (ioctl(of_fd, OFIOCFINDDEVICE, &ofio) < 0)
    401  1.1  macallan 		err(1, "OFIOCFINDDEVICE(%d, \"%s\")", of_fd, ofio.of_name);
    402  1.1  macallan #endif
    403  1.1  macallan 	return 0;
    404  1.1  macallan }
    405  1.1  macallan 
    406  1.1  macallan struct of_prop *
    407  1.1  macallan of_tree_getprop(int nodeid, char *name)
    408  1.1  macallan {
    409  1.1  macallan 	struct of_node *node;
    410  1.1  macallan 	struct of_prop *prop;
    411  1.1  macallan 
    412  1.1  macallan 	if (nodeid == 0)
    413  1.1  macallan 		return 0;
    414  1.1  macallan 
    415  1.1  macallan 	node = of_tree_walk(&of_root, of_match_by_nodeid, &nodeid);
    416  1.1  macallan 	if (node == NULL)
    417  1.1  macallan 		return NULL;
    418  1.1  macallan 
    419  1.1  macallan 	if (name[0] == '\0')
    420  1.1  macallan 		return TAILQ_FIRST(&node->of_properties);
    421  1.1  macallan 
    422  1.1  macallan 	if (!strcmp(name, "name"))
    423  1.1  macallan 		return node->of_name;
    424  1.1  macallan 	if (!strcmp(name, "device_type"))
    425  1.1  macallan 		return node->of_device_type;
    426  1.1  macallan 	if (!strcmp(name, "reg"))
    427  1.1  macallan 		return node->of_reg;
    428  1.1  macallan 
    429  1.1  macallan 	TAILQ_FOREACH(prop, &node->of_properties, prop_sibling) {
    430  1.1  macallan 		if (!strcmp(name, prop->prop_name))
    431  1.1  macallan 			break;
    432  1.1  macallan 	}
    433  1.1  macallan 	return prop;
    434  1.1  macallan }
    435  1.1  macallan 
    436  1.1  macallan int
    437  1.1  macallan OF_getproplen(int nodeid, char *name)
    438  1.1  macallan {
    439  1.1  macallan 	struct of_prop *prop = of_tree_getprop(nodeid, name);
    440  1.1  macallan 	return (prop != NULL) ? prop->prop_length : -1;
    441  1.1  macallan }
    442  1.1  macallan 
    443  1.1  macallan int
    444  1.1  macallan OF_getprop(int nodeid, char *name, void *buf, size_t len)
    445  1.1  macallan {
    446  1.1  macallan 	struct of_prop *prop = of_tree_getprop(nodeid, name);
    447  1.1  macallan 	if (prop == NULL)
    448  1.1  macallan 		return -1;
    449  1.1  macallan 	if (len > prop->prop_length)
    450  1.1  macallan 		len = prop->prop_length;
    451  1.1  macallan 	memcpy(buf, prop->prop_data, len);
    452  1.1  macallan 	return len;
    453  1.1  macallan }
    454  1.1  macallan 
    455  1.1  macallan int
    456  1.1  macallan OF_nextprop(int nodeid, char *name, void *nextname)
    457  1.1  macallan {
    458  1.1  macallan 	struct of_prop *prop = of_tree_getprop(nodeid, name);
    459  1.1  macallan 	if (prop == NULL)
    460  1.1  macallan 		return -1;
    461  1.1  macallan 	if (name[0] != '\0') {
    462  1.1  macallan 		prop = TAILQ_NEXT(prop, prop_sibling);
    463  1.1  macallan 		if (prop == NULL)
    464  1.1  macallan 			return -1;
    465  1.1  macallan 	}
    466  1.1  macallan 	strcpy(nextname, prop->prop_name);
    467  1.1  macallan 	return strlen(prop->prop_name);
    468  1.1  macallan }
    469  1.1  macallan 
    470  1.1  macallan static u_int32_t
    471  1.1  macallan of_decode_int(const u_int8_t *p)
    472  1.1  macallan {
    473  1.1  macallan 	return (p[0] << 24) | (p[1] << 16) | (p[2] << 8) | p[3];
    474  1.1  macallan }
    475  1.1  macallan 
    476  1.1  macallan /*
    477  1.1  macallan  * Now we start the real program
    478  1.1  macallan  */
    479  1.1  macallan 
    480  1.1  macallan int
    481  1.1  macallan main(int argc, char **argv)
    482  1.1  macallan {
    483  1.1  macallan 	u_long of_buf[256];
    484  1.1  macallan 	char device_type[33];
    485  1.1  macallan 	int phandle;
    486  1.1  macallan 	int errflag = 0;
    487  1.1  macallan 	int c;
    488  1.1  macallan 	int len;
    489  1.1  macallan #if defined(__sparc__) || defined(__sparc64__)
    490  1.1  macallan 	const char *file = "/dev/openprom";
    491  1.1  macallan #else
    492  1.1  macallan 	const char *file = "/dev/openfirm";
    493  1.1  macallan #endif
    494  1.4      matt 	const char *propfilein = NULL;
    495  1.4      matt 	const char *propfileout = NULL;
    496  1.1  macallan 
    497  1.4      matt 	while ((c = getopt(argc, argv, "f:lpr:w:")) != EOF) {
    498  1.1  macallan 		switch (c) {
    499  1.1  macallan 		case 'l': lflag++; break;
    500  1.1  macallan 		case 'p': pflag++; break;
    501  1.1  macallan 		case 'f': file = optarg; break;
    502  1.4      matt 		case 'r': propfilein = optarg; break;
    503  1.4      matt 		case 'w': propfileout = optarg; break;
    504  1.1  macallan 		default: errflag++; break;
    505  1.1  macallan 		}
    506  1.1  macallan 	}
    507  1.1  macallan 	if (errflag)
    508  1.6      jmmv 		errx(1, "usage: ofctl [-pl] [-f file] [-r propfile] [-w propfile] [node...]");
    509  1.4      matt 
    510  1.4      matt 	if (propfilein != NULL) {
    511  1.4      matt 		of_proplib = prop_dictionary_internalize_from_file(propfilein);
    512  1.4      matt 	} else {
    513  1.4      matt 		of_proplib = of_proplib_init(file);
    514  1.4      matt 	}
    515  1.4      matt 
    516  1.4      matt 	if (propfileout)
    517  1.4      matt 		prop_dictionary_externalize_to_file(of_proplib, propfileout);
    518  1.1  macallan 
    519  1.4      matt 	of_tree_init(of_proplib);
    520  1.1  macallan 	printf("[Caching %lu nodes and %lu properties]\n",
    521  1.1  macallan 		of_node_count, of_prop_count);
    522  1.1  macallan 
    523  1.1  macallan 	if (argc == optind) {
    524  1.1  macallan 		phandle = OF_peer(0);
    525  1.1  macallan 		device_type[0] = '\0';
    526  1.1  macallan 		len = OF_getprop(phandle, "device_type", device_type,
    527  1.1  macallan 		    sizeof(device_type));
    528  1.1  macallan 		if (len <= 0)
    529  1.1  macallan 			len = OF_getprop(phandle, "name", device_type,
    530  1.1  macallan 			    sizeof(device_type));
    531  1.1  macallan 		if (len >= 0)
    532  1.1  macallan 			device_type[len] = '\0';
    533  1.1  macallan 		oflist(phandle, device_type, 0, of_buf, sizeof(of_buf));
    534  1.1  macallan 	} else {
    535  1.1  macallan #if 0
    536  1.1  macallan 		pandle = OF_finddevice(argv[optind++]);
    537  1.1  macallan 
    538  1.1  macallan 		if (argc == optind) {
    539  1.1  macallan 			if (lflag)
    540  1.1  macallan 				oflist(phandle, 0, of_buf, sizeof(of_buf));
    541  1.1  macallan 			else
    542  1.1  macallan 				ofprop(phandle);
    543  1.1  macallan 		} else {
    544  1.1  macallan 			for (; optind < argc; optind++) {
    545  1.1  macallan 				ofgetprop(phandle, argv[optind]);
    546  1.1  macallan 			}
    547  1.1  macallan 		}
    548  1.1  macallan #else
    549  1.1  macallan 		printf("%s: OF_finddevice not yet implemented\n", argv[optind]);
    550  1.1  macallan #endif
    551  1.1  macallan 	}
    552  1.1  macallan 	exit(0);
    553  1.1  macallan }
    554  1.1  macallan 
    555  1.1  macallan static size_t
    556  1.1  macallan ofname(int node, char *buf, size_t buflen)
    557  1.1  macallan {
    558  1.1  macallan 	u_int8_t address_cells_buf[4];
    559  1.1  macallan 	u_int8_t reg_buf[4096];
    560  1.1  macallan 	char name[33];
    561  1.1  macallan 	char device_type[33];
    562  1.1  macallan 	size_t off = 0;
    563  1.1  macallan 	int parent = OF_parent(node);
    564  1.1  macallan 	int reglen;
    565  1.1  macallan 	int reg[sizeof(reg_buf)/sizeof(int)];
    566  1.1  macallan 	int address_cells;
    567  1.1  macallan 	int len;
    568  1.1  macallan 
    569  1.1  macallan 	len = OF_getprop(node, "name", name, sizeof(name));
    570  1.1  macallan 	assert(len > 0);
    571  1.1  macallan 	off += snprintf(buf + off, buflen - off, "/%s", name);
    572  1.1  macallan 
    573  1.1  macallan 	reglen = OF_getprop(node, "reg", reg_buf, sizeof(reg_buf));
    574  1.1  macallan 	if (reglen <= 0)
    575  1.1  macallan 		return off;
    576  1.1  macallan 
    577  1.1  macallan 	len = OF_getprop(parent, "device_type",
    578  1.1  macallan 	    device_type, sizeof(device_type));
    579  1.1  macallan 	if (len <= 0)
    580  1.1  macallan 		len = OF_getprop(parent, "name",
    581  1.1  macallan 		    device_type, sizeof(device_type));
    582  1.1  macallan 	device_type[len] = '\0';
    583  1.1  macallan 
    584  1.1  macallan 	for (;;) {
    585  1.1  macallan 		len = OF_getprop(parent, "#address-cells",
    586  1.1  macallan 		    address_cells_buf, sizeof(address_cells_buf));
    587  1.1  macallan 		if (len >= 0) {
    588  1.1  macallan 			assert(len == 4);
    589  1.1  macallan 			break;
    590  1.1  macallan 		}
    591  1.1  macallan 		parent = OF_parent(parent);
    592  1.1  macallan 		if (parent == 0)
    593  1.1  macallan 			break;
    594  1.1  macallan 	}
    595  1.1  macallan 
    596  1.1  macallan 	if (parent == 0) {
    597  1.1  macallan 
    598  1.1  macallan 		parent = OF_parent(node);
    599  1.3  macallan 
    600  1.1  macallan 		for (;;) {
    601  1.1  macallan 			len = OF_getprop(parent, "#size-cells",
    602  1.1  macallan 			    address_cells_buf, sizeof(address_cells_buf));
    603  1.1  macallan 			if (len >= 0) {
    604  1.1  macallan 				assert(len == 4);
    605  1.1  macallan 				break;
    606  1.1  macallan 			}
    607  1.1  macallan 			parent = OF_parent(parent);
    608  1.1  macallan 			if (parent == 0)
    609  1.1  macallan 				break;
    610  1.1  macallan 		}
    611  1.3  macallan 		/* no #size-cells */
    612  1.3  macallan 		len = 0;
    613  1.3  macallan 	}
    614  1.3  macallan 
    615  1.3  macallan 	if (len == 0) {
    616  1.3  macallan 		/* looks like we're on an OBP2 system */
    617  1.3  macallan 		if (reglen > 12)
    618  1.3  macallan 			return off;
    619  1.3  macallan 		off += snprintf(buf + off, buflen - off, "@");
    620  1.3  macallan 		memcpy(reg, reg_buf, 8);
    621  1.3  macallan 		off += snprintf(buf + off, buflen - off, "%x,%x", reg[0],
    622  1.3  macallan 		    reg[1]);
    623  1.3  macallan 		return off;
    624  1.1  macallan 	}
    625  1.1  macallan 
    626  1.1  macallan 	off += snprintf(buf + off, buflen - off, "@");
    627  1.1  macallan 	address_cells = of_decode_int(address_cells_buf);
    628  1.1  macallan 	for (len = 0; len < address_cells; len ++)
    629  1.1  macallan 		reg[len] = of_decode_int(&reg_buf[len * 4]);
    630  1.1  macallan 
    631  1.1  macallan 	if (!strcmp(device_type,"pci")) {
    632  1.1  macallan 		off += snprintf(buf + off, buflen - off,
    633  1.1  macallan 		    "%x", (reg[0] >> 11) & 31);
    634  1.1  macallan 		if (reg[0] & 0x700)
    635  1.1  macallan 			off += snprintf(buf + off, buflen - off,
    636  1.1  macallan 			    ",%x", (reg[0] >> 8) & 7);
    637  1.1  macallan 	} else if (!strcmp(device_type,"upa")) {
    638  1.1  macallan 		off += snprintf(buf + off, buflen - off,
    639  1.1  macallan 		    "%x", (reg[0] >> 4) & 63);
    640  1.1  macallan 		for (len = 1; len < address_cells; len++)
    641  1.1  macallan 			off += snprintf(buf + off, buflen - off,
    642  1.1  macallan 			    ",%x", reg[len]);
    643  1.1  macallan #if !defined(__sparc__) && !defined(__sparc64__)
    644  1.1  macallan 	} else if (!strcmp(device_type,"isa")) {
    645  1.1  macallan #endif
    646  1.1  macallan 	} else {
    647  1.1  macallan 		off += snprintf(buf + off, buflen - off, "%x", reg[0]);
    648  1.1  macallan 		for (len = 1; len < address_cells; len++)
    649  1.1  macallan 			off += snprintf(buf + off, buflen - off,
    650  1.1  macallan 			    ",%x", reg[len]);
    651  1.1  macallan 	}
    652  1.1  macallan 	return off;
    653  1.1  macallan }
    654  1.1  macallan 
    655  1.1  macallan static size_t
    656  1.1  macallan offullname2(int node, char *buf, size_t len)
    657  1.1  macallan {
    658  1.1  macallan 	size_t off;
    659  1.1  macallan 	int parent = OF_parent(node);
    660  1.1  macallan 	if (parent == 0)
    661  1.1  macallan 		return 0;
    662  1.1  macallan 
    663  1.1  macallan 	off = offullname2(parent, buf, len);
    664  1.1  macallan 	off += ofname(node, buf + off, len - off);
    665  1.1  macallan 	return off;
    666  1.1  macallan }
    667  1.1  macallan 
    668  1.1  macallan static size_t
    669  1.1  macallan offullname(int node, char *buf, size_t len)
    670  1.1  macallan {
    671  1.1  macallan 	if (node == OF_peer(0)) {
    672  1.1  macallan 		size_t off = snprintf(buf, len, "/");
    673  1.1  macallan 		off += OF_getprop(node, "name", buf + off, len - off);
    674  1.1  macallan 		return off;
    675  1.1  macallan 	}
    676  1.1  macallan 	return offullname2(node, buf, len);
    677  1.1  macallan }
    678  1.1  macallan 
    679  1.1  macallan static void
    680  1.1  macallan oflist(int node, const char *parent_device_type, int depth,
    681  1.1  macallan 	void *of_buf, size_t of_buflen)
    682  1.1  macallan {
    683  1.1  macallan 	int len;
    684  1.1  macallan 	while (node != 0) {
    685  1.1  macallan 		int child;
    686  1.1  macallan 		if (pflag == 0) {
    687  1.1  macallan 			len = ofname(node, of_buf, of_buflen-1);
    688  1.1  macallan 			printf("%08x: %*s%s", node, depth * 2, "",
    689  1.1  macallan 			    (char *) of_buf);
    690  1.1  macallan 		} else {
    691  1.1  macallan 			len = offullname(node, of_buf, of_buflen-1);
    692  1.1  macallan 			printf("%08x: %s", node, (char *) of_buf);
    693  1.1  macallan 		}
    694  1.1  macallan 		putchar('\n');
    695  1.1  macallan 		if (pflag) {
    696  1.1  macallan 			putchar('\n');
    697  1.1  macallan 			ofprop(node);
    698  1.1  macallan 			puts("\n----------------------------------------"
    699  1.1  macallan 			    "----------------------------------------\n\n");
    700  1.1  macallan 		}
    701  1.1  macallan 		child = OF_child(node);
    702  1.1  macallan 		if (child != -1 && child != 0) {
    703  1.1  macallan 			char device_type[33];
    704  1.1  macallan 			len = OF_getprop(node, "device_type",
    705  1.1  macallan 			    device_type, sizeof(device_type));
    706  1.1  macallan 			if (len <= 0)
    707  1.1  macallan 				len = OF_getprop(node, "name",
    708  1.1  macallan 				    device_type, sizeof(device_type));
    709  1.1  macallan 			if (len >= 0)
    710  1.1  macallan 				device_type[len] = '\0';
    711  1.1  macallan 			depth++;
    712  1.1  macallan 			oflist(child, device_type, depth, of_buf, of_buflen);
    713  1.1  macallan 			depth--;
    714  1.1  macallan 		}
    715  1.1  macallan 		if (depth == 0)
    716  1.1  macallan 			break;
    717  1.1  macallan 		node = OF_peer(node);
    718  1.1  macallan 	}
    719  1.1  macallan }
    720  1.1  macallan 
    721  1.1  macallan static void
    722  1.1  macallan print_line(const u_int8_t *buf, size_t off, size_t len)
    723  1.1  macallan {
    724  1.1  macallan 	if (len - off > 16)
    725  1.1  macallan 		len = off + 16;
    726  1.1  macallan 
    727  1.1  macallan 	for (; off < ((len + 15) & ~15); off++) {
    728  1.1  macallan 		if (off > 0) {
    729  1.1  macallan 			if ((off & 15) == 0)
    730  1.1  macallan 				printf("%12s%04lx:%7s", "",
    731  1.1  macallan 				    (unsigned long int) off, "");
    732  1.1  macallan 			else if ((off & 3) == 0)
    733  1.1  macallan 				putchar(' ');
    734  1.1  macallan 		}
    735  1.1  macallan 		if (off < len)
    736  1.1  macallan 			printf("%02x", buf[off]);
    737  1.1  macallan #if 0
    738  1.1  macallan 		else if (off >= ((len + 3) & ~3))
    739  1.1  macallan 			printf("  ");
    740  1.1  macallan #endif
    741  1.1  macallan 		else
    742  1.1  macallan 			printf("..");
    743  1.1  macallan 	}
    744  1.1  macallan }
    745  1.1  macallan 
    746  1.1  macallan static void
    747  1.1  macallan default_format(int node, const u_int8_t *buf, size_t len)
    748  1.1  macallan {
    749  1.1  macallan 	size_t off = 0;
    750  1.1  macallan 	while (off < len) {
    751  1.1  macallan 		size_t end;
    752  1.1  macallan 		print_line(buf, off, len);
    753  1.1  macallan 		printf("   ");	/* 24 + 32 + 3 = 59, so +3 makes 62 */
    754  1.1  macallan 		end = len;
    755  1.1  macallan 		if (end > off + 16)
    756  1.1  macallan 			end = off + 16;
    757  1.1  macallan 		for (; off < end; off++) {
    758  1.1  macallan 			char ch = buf[off];
    759  1.1  macallan 			if (isascii(ch) &&
    760  1.1  macallan 			    (isalnum((int)ch) || ispunct((int)ch) || ch == ' '))
    761  1.1  macallan 				putchar(ch);
    762  1.1  macallan 			else
    763  1.1  macallan 				putchar('.');
    764  1.1  macallan 		}
    765  1.1  macallan 		putchar('\n');
    766  1.1  macallan 	}
    767  1.1  macallan }
    768  1.1  macallan 
    769  1.1  macallan static void
    770  1.1  macallan reg_format(int node, const u_int8_t *buf, size_t len)
    771  1.1  macallan {
    772  1.1  macallan 	/* parent = OF_parent(node); */
    773  1.1  macallan 	default_format(node, buf, len);
    774  1.1  macallan }
    775  1.1  macallan 
    776  1.1  macallan static void
    777  1.1  macallan frequency_format(int node, const u_int8_t *buf, size_t len)
    778  1.1  macallan {
    779  1.1  macallan 	if (len == 4) {
    780  1.1  macallan 		u_int32_t freq = of_decode_int(buf);
    781  1.1  macallan 		u_int32_t divisor, whole, frac;
    782  1.1  macallan 		const char *units = "";
    783  1.1  macallan 		print_line(buf, 0, len);
    784  1.1  macallan 		for (divisor = 1000000000; divisor > 1; divisor /= 1000) {
    785  1.1  macallan 			if (freq >= divisor)
    786  1.1  macallan 				break;
    787  1.1  macallan 		}
    788  1.1  macallan 		whole = freq / divisor;
    789  1.1  macallan 		if (divisor == 1)
    790  1.1  macallan 			frac = 0;
    791  1.1  macallan 		else
    792  1.1  macallan 			frac = (freq / (divisor / 1000)) % 1000;
    793  1.1  macallan 
    794  1.1  macallan 		switch (divisor) {
    795  1.1  macallan 		case 1000000000: units = "GHz"; break;
    796  1.1  macallan 		case    1000000: units = "MHz"; break;
    797  1.1  macallan 		case       1000: units = "KHz"; break;
    798  1.1  macallan 		case          1: units =  "Hz"; break;
    799  1.1  macallan 		}
    800  1.1  macallan 		if (frac > 0)
    801  1.1  macallan 			printf("   %u.%03u%s\n", whole, frac, units);
    802  1.1  macallan 		else
    803  1.1  macallan 			printf("   %u%s\n", whole, units);
    804  1.1  macallan 	} else
    805  1.1  macallan 		default_format(node, buf, len);
    806  1.1  macallan }
    807  1.1  macallan 
    808  1.1  macallan static void
    809  1.1  macallan size_format(int node, const u_int8_t *buf, size_t len)
    810  1.1  macallan {
    811  1.1  macallan 	if (len == 4) {
    812  1.1  macallan 		u_int32_t freq = of_decode_int(buf);
    813  1.1  macallan 		u_int32_t divisor, whole, frac;
    814  1.1  macallan 		const char *units = "";
    815  1.1  macallan 		print_line(buf, 0, len);
    816  1.1  macallan 		for (divisor = 0x40000000; divisor > 1; divisor >>= 10) {
    817  1.1  macallan 			if (freq >= divisor)
    818  1.1  macallan 				break;
    819  1.1  macallan 		}
    820  1.1  macallan 		whole = freq / divisor;
    821  1.1  macallan 		if (divisor == 1)
    822  1.1  macallan 			frac = 0;
    823  1.1  macallan 		else
    824  1.1  macallan 			frac = (freq / (divisor >> 10)) & 1023;
    825  1.1  macallan 
    826  1.1  macallan 		switch (divisor) {
    827  1.1  macallan 		case 0x40000000: units = "G"; break;
    828  1.1  macallan 		case   0x100000: units = "M"; break;
    829  1.1  macallan 		case      0x400: units = "K"; break;
    830  1.1  macallan 		case          1: units =  ""; break;
    831  1.1  macallan 		}
    832  1.1  macallan 		if (frac > 0)
    833  1.1  macallan 			printf("   %3u.%03u%s\n", whole, frac, units);
    834  1.1  macallan 		else
    835  1.1  macallan 			printf("   %3u%s\n", whole, units);
    836  1.1  macallan 	} else
    837  1.1  macallan 		default_format(node, buf, len);
    838  1.1  macallan }
    839  1.1  macallan 
    840  1.1  macallan static void
    841  1.1  macallan string_format(int node, const u_int8_t *buf, size_t len)
    842  1.1  macallan {
    843  1.1  macallan 	size_t off = 0;
    844  1.1  macallan 	int first_line = 1;
    845  1.1  macallan 	while (off < len) {
    846  1.1  macallan 		size_t string_len = 0;
    847  1.1  macallan 		int leading = 1;
    848  1.1  macallan 		for (; off + string_len < len; string_len++) {
    849  1.1  macallan 			if (buf[off+string_len] == '\0') {
    850  1.1  macallan 				string_len++;
    851  1.1  macallan 				break;
    852  1.1  macallan 			}
    853  1.1  macallan 		}
    854  1.1  macallan 		while (string_len > 0) {
    855  1.1  macallan 			size_t line_len = string_len;
    856  1.1  macallan 			if (line_len > 16)
    857  1.1  macallan 				line_len = 16;
    858  1.1  macallan 			if (!first_line)
    859  1.1  macallan 				printf("%12s%04lx:%7s", "",
    860  1.1  macallan 				    (unsigned long int) off, "");
    861  1.1  macallan 			print_line(buf + off, 0, line_len);
    862  1.1  macallan 			printf("   ");
    863  1.1  macallan 			if (leading)
    864  1.1  macallan 				putchar('"');
    865  1.1  macallan 			first_line = 0;
    866  1.1  macallan 			leading = 0;
    867  1.1  macallan 			string_len -= line_len;
    868  1.1  macallan 			for (; line_len > 0; line_len--, off++) {
    869  1.1  macallan 				if (buf[off] != '\0')
    870  1.1  macallan 					putchar(buf[off]);
    871  1.1  macallan 			}
    872  1.1  macallan 			if (string_len == 0)
    873  1.1  macallan 				putchar('"');
    874  1.1  macallan 			putchar('\n');
    875  1.1  macallan 		}
    876  1.1  macallan 	}
    877  1.1  macallan }
    878  1.1  macallan 
    879  1.1  macallan static const struct {
    880  1.1  macallan 	const char *prop_name;
    881  1.1  macallan 	void (*prop_format)(int, const u_int8_t *, size_t);
    882  1.1  macallan } formatters[] = {
    883  1.1  macallan 	{ "reg", reg_format },
    884  1.1  macallan #if 0
    885  1.1  macallan 	{ "assigned-addresses", assigned_addresses_format },
    886  1.1  macallan 	{ "ranges", ranges_format },
    887  1.1  macallan 	{ "interrupt-map", interrup_map_format },
    888  1.1  macallan 	{ "interrupt", interrupt_format },
    889  1.1  macallan #endif
    890  1.1  macallan 	{ "model", string_format },
    891  1.1  macallan 	{ "name", string_format },
    892  1.1  macallan 	{ "device_type", string_format },
    893  1.1  macallan 	{ "compatible", string_format },
    894  1.1  macallan 	{ "*frequency", frequency_format },
    895  1.1  macallan 	{ "*-size", size_format },
    896  1.1  macallan 	{ "*-cells", size_format },
    897  1.1  macallan 	{ "*-entries", size_format },
    898  1.1  macallan 	{ "*-associativity", size_format },
    899  1.1  macallan 	{ NULL, default_format }
    900  1.1  macallan };
    901  1.1  macallan 
    902  1.1  macallan static void
    903  1.1  macallan ofgetprop(int node, char *name)
    904  1.1  macallan {
    905  1.1  macallan 	u_int8_t of_buf[4097];
    906  1.1  macallan 	int len;
    907  1.1  macallan 	int i;
    908  1.1  macallan 
    909  1.1  macallan 	len = OF_getprop(node, name, of_buf, sizeof(of_buf) - 1);
    910  1.1  macallan 	if (len < 0)
    911  1.1  macallan 		return;
    912  1.1  macallan 	of_buf[len] = '\0';
    913  1.1  macallan 	printf("%-24s", name);
    914  1.1  macallan 	if (len == 0) {
    915  1.1  macallan 		putchar('\n');
    916  1.1  macallan 		return;
    917  1.1  macallan 	}
    918  1.1  macallan 	if (strlen(name) >= 24)
    919  1.1  macallan 		printf("\n%24s", "");
    920  1.1  macallan 
    921  1.1  macallan 	for (i = 0; formatters[i].prop_name != NULL; i++) {
    922  1.1  macallan 		if (formatters[i].prop_name[0] == '*') {
    923  1.1  macallan 			if (strstr(name, &formatters[i].prop_name[1]) != NULL) {
    924  1.1  macallan 				(*formatters[i].prop_format)(node, of_buf, len);
    925  1.1  macallan 				return;
    926  1.1  macallan 			}
    927  1.1  macallan 			continue;
    928  1.1  macallan 		}
    929  1.1  macallan 		if (strcmp(name, formatters[i].prop_name) == 0) {
    930  1.1  macallan 			(*formatters[i].prop_format)(node, of_buf, len);
    931  1.1  macallan 			return;
    932  1.1  macallan 		}
    933  1.1  macallan 	}
    934  1.1  macallan 	(*formatters[i].prop_format)(node, of_buf, len);
    935  1.1  macallan }
    936  1.1  macallan 
    937  1.1  macallan static void
    938  1.1  macallan ofprop(int node)
    939  1.1  macallan {
    940  1.1  macallan 	char namebuf[33];
    941  1.1  macallan 	char newnamebuf[33];
    942  1.1  macallan 	int len;
    943  1.1  macallan 
    944  1.1  macallan 	namebuf[0] = '\0';
    945  1.1  macallan 
    946  1.1  macallan 	for (;;) {
    947  1.1  macallan 		len = OF_nextprop(node, namebuf, newnamebuf);
    948  1.1  macallan 		if (len <= 0)
    949  1.1  macallan 			break;
    950  1.1  macallan 
    951  1.1  macallan 		newnamebuf[len] = '\0';
    952  1.1  macallan 		strcpy(namebuf, newnamebuf);
    953  1.1  macallan 		ofgetprop(node, newnamebuf);
    954  1.1  macallan 	}
    955  1.1  macallan }
    956  1.1  macallan #if 0
    957  1.1  macallan static int
    958  1.1  macallan isstrprint(const char *str, size_t len, int ignorenulls)
    959  1.1  macallan {
    960  1.1  macallan 	if (*str == '\0')
    961  1.1  macallan 		return 0;
    962  1.1  macallan 	for (; len-- > 0; str++) {
    963  1.1  macallan 		if (*str == '\0' && len > 0 && str[1] == '\0')
    964  1.1  macallan 			return 0;
    965  1.1  macallan 		if (len == 0 && *str == '\0')
    966  1.1  macallan 			return 1;
    967  1.1  macallan 		if (ignorenulls) {
    968  1.1  macallan 			if (*str == '\0')
    969  1.1  macallan 				continue;
    970  1.1  macallan 			if (isalnum(*str) || ispunct(*str) || *str == ' ')
    971  1.1  macallan 				continue;
    972  1.1  macallan 			return 0;
    973  1.1  macallan 		}
    974  1.1  macallan 		if (!isprint(*str))
    975  1.1  macallan 			return 0;
    976  1.1  macallan 	}
    977  1.1  macallan 	return 1;
    978  1.1  macallan }
    979  1.1  macallan #endif
    980