devicename.c revision 123703
1/*- 2 * Copyright (c) 1998 Michael Smith <msmith@freebsd.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 * $FreeBSD: head/sys/boot/ofw/libofw/devicename.c 123703 2003-12-21 12:38:25Z grehan $ 27 */ 28 29#include <stand.h> 30#include "libofw.h" 31 32static int ofw_parsedev(struct ofw_devdesc **, const char *, const char **); 33 34/* 35 * Point (dev) at an allocated device specifier for the device matching the 36 * path in (devspec). If it contains an explicit device specification, 37 * use that. If not, use the default device. 38 */ 39int 40ofw_getdev(void **vdev, const char *devspec, const char **path) 41{ 42 struct ofw_devdesc **dev = (struct ofw_devdesc **)vdev; 43 int rv; 44 45 /* 46 * If it looks like this is just a path and no 47 * device, go with the current device. 48 */ 49 if ((devspec == NULL) || 50 ((strchr(devspec, '@') == NULL) && 51 (strchr(devspec, ':') == NULL))) { 52 53 if (((rv = ofw_parsedev(dev, getenv("currdev"), NULL)) == 0) && 54 (path != NULL)) 55 *path = devspec; 56 return(rv); 57 } 58 59 /* 60 * Try to parse the device name off the beginning of the devspec 61 */ 62 return(ofw_parsedev(dev, devspec, path)); 63} 64 65/* 66 * Point (dev) at an allocated device specifier matching the string version 67 * at the beginning of (devspec). Return a pointer to the remaining 68 * text in (path). 69 */ 70static int 71ofw_parsedev(struct ofw_devdesc **dev, const char *devspec, const char **path) 72{ 73 struct ofw_devdesc *idev; 74 struct devsw *dv; 75 phandle_t handle; 76 const char *p; 77 const char *s; 78 char name[256]; 79 char type[64]; 80 int len; 81 int i; 82 83 for (p = s = devspec; *s != '\0'; p = s) { 84 if ((s = strchr(p + 1, '/')) == NULL) 85 s = strchr(p, '\0'); 86 len = s - devspec; 87 bcopy(devspec, name, len); 88 name[len] = '\0'; 89 if ((handle = OF_finddevice(name)) == -1) 90 break; 91 if (OF_getprop(handle, "device_type", type, sizeof(type)) == -1) 92 continue; 93 for (i = 0; (dv = devsw[i]) != NULL; i++) { 94 if (strncmp(dv->dv_name, type, strlen(dv->dv_name)) == 0) 95 goto found; 96 } 97 } 98 return(ENOENT); 99 100found: 101 if (*s != '\0') 102 *path = s; 103 idev = malloc(sizeof(struct ofw_devdesc)); 104 strcpy(idev->d_path, name); 105 idev->d_dev = dv; 106 idev->d_type = dv->dv_type; 107 if (dev == NULL) { 108 free(idev); 109 } else { 110 *dev = idev; 111 } 112 return(0); 113} 114 115int 116ofw_setcurrdev(struct env_var *ev, int flags, const void *value) 117{ 118 struct ofw_devdesc *ncurr; 119 int rv; 120 121 if ((rv = ofw_parsedev(&ncurr, value, NULL)) != 0) 122 return rv; 123 124 free(ncurr); 125 env_setenv(ev->ev_name, flags | EV_NOHOOK, value, NULL, NULL); 126 return 0; 127} 128