devicename.c revision 113583
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 113583 2003-04-16 21:09:41Z phk $ 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 52 if (((rv = ofw_parsedev(dev, getenv("currdev"), NULL)) == 0) && 53 (path != NULL)) 54 *path = devspec; 55 return(rv); 56 } 57 58 /* 59 * Try to parse the device name off the beginning of the devspec 60 */ 61 return(ofw_parsedev(dev, devspec, path)); 62} 63 64/* 65 * Point (dev) at an allocated device specifier matching the string version 66 * at the beginning of (devspec). Return a pointer to the remaining 67 * text in (path). 68 */ 69static int 70ofw_parsedev(struct ofw_devdesc **dev, const char *devspec, const char **path) 71{ 72 struct ofw_devdesc *idev; 73 struct devsw *dv; 74 phandle_t handle; 75 const char *p; 76 const char *s; 77 char name[256]; 78 char type[64]; 79 int len; 80 int i; 81 82 for (p = s = devspec; *s != '\0'; p = s) { 83 if ((s = strchr(p + 1, '/')) == NULL) 84 s = strchr(p, '\0'); 85 len = s - devspec; 86 bcopy(devspec, name, len); 87 name[len] = '\0'; 88 if ((handle = OF_finddevice(name)) == -1) 89 break; 90 if (OF_getprop(handle, "device_type", type, sizeof(type)) == -1) 91 continue; 92 for (i = 0; (dv = devsw[i]) != NULL; i++) { 93 if (strncmp(dv->dv_name, type, strlen(dv->dv_name)) == 0) 94 goto found; 95 } 96 } 97 return(ENOENT); 98 99found: 100 if (*s != '\0') 101 *path = s; 102 idev = malloc(sizeof(struct ofw_devdesc)); 103 strcpy(idev->d_path, name); 104 idev->d_dev = dv; 105 idev->d_type = dv->dv_type; 106 if (dev == NULL) { 107 free(idev); 108 } else { 109 *dev = idev; 110 } 111 return(0); 112} 113 114int 115ofw_setcurrdev(struct env_var *ev, int flags, void *value) 116{ 117 struct ofw_devdesc *ncurr; 118 int rv; 119 120 if ((rv = ofw_parsedev(&ncurr, value, NULL)) != 0) 121 return rv; 122 123 free(ncurr); 124 env_setenv(ev->ev_name, flags | EV_NOHOOK, value, NULL, NULL); 125 return 0; 126} 127