devicename.c revision 124140
1219439Spjd/*- 2219439Spjd * Copyright (c) 1998 Michael Smith <msmith@freebsd.org> 3219439Spjd * All rights reserved. 4219439Spjd * 5219439Spjd * Redistribution and use in source and binary forms, with or without 6219439Spjd * modification, are permitted provided that the following conditions 7219439Spjd * are met: 8219439Spjd * 1. Redistributions of source code must retain the above copyright 9219439Spjd * notice, this list of conditions and the following disclaimer. 10219439Spjd * 2. Redistributions in binary form must reproduce the above copyright 11219439Spjd * notice, this list of conditions and the following disclaimer in the 12219439Spjd * documentation and/or other materials provided with the distribution. 13219439Spjd * 14219439Spjd * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15219439Spjd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16219439Spjd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17219439Spjd * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18219439Spjd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19219439Spjd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20219439Spjd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21219439Spjd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22219439Spjd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23219439Spjd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24219439Spjd * SUCH DAMAGE. 25219439Spjd */ 26219439Spjd 27219439Spjd#include <sys/cdefs.h> 28219439Spjd__FBSDID("$FreeBSD: head/sys/boot/ofw/libofw/devicename.c 124140 2004-01-04 23:30:47Z obrien $"); 29219439Spjd 30219439Spjd#include <stand.h> 31219439Spjd#include "libofw.h" 32219439Spjd 33219439Spjdstatic int ofw_parsedev(struct ofw_devdesc **, const char *, const char **); 34219439Spjd 35219439Spjd/* 36219439Spjd * Point (dev) at an allocated device specifier for the device matching the 37219439Spjd * path in (devspec). If it contains an explicit device specification, 38219439Spjd * use that. If not, use the default device. 39219439Spjd */ 40219439Spjdint 41219439Spjdofw_getdev(void **vdev, const char *devspec, const char **path) 42219439Spjd{ 43219439Spjd struct ofw_devdesc **dev = (struct ofw_devdesc **)vdev; 44219439Spjd int rv; 45219439Spjd 46219439Spjd /* 47219439Spjd * If it looks like this is just a path and no 48219439Spjd * device, go with the current device. 49219439Spjd */ 50219439Spjd if ((devspec == NULL) || 51219439Spjd ((strchr(devspec, '@') == NULL) && 52219439Spjd (strchr(devspec, ':') == NULL))) { 53219439Spjd 54219439Spjd if (((rv = ofw_parsedev(dev, getenv("currdev"), NULL)) == 0) && 55219439Spjd (path != NULL)) 56219439Spjd *path = devspec; 57219439Spjd return(rv); 58219439Spjd } 59 60 /* 61 * Try to parse the device name off the beginning of the devspec 62 */ 63 return(ofw_parsedev(dev, devspec, path)); 64} 65 66/* 67 * Point (dev) at an allocated device specifier matching the string version 68 * at the beginning of (devspec). Return a pointer to the remaining 69 * text in (path). 70 */ 71static int 72ofw_parsedev(struct ofw_devdesc **dev, const char *devspec, const char **path) 73{ 74 struct ofw_devdesc *idev; 75 struct devsw *dv; 76 phandle_t handle; 77 const char *p; 78 const char *s; 79 char name[256]; 80 char type[64]; 81 int len; 82 int i; 83 84 for (p = s = devspec; *s != '\0'; p = s) { 85 if ((s = strchr(p + 1, '/')) == NULL) 86 s = strchr(p, '\0'); 87 len = s - devspec; 88 bcopy(devspec, name, len); 89 name[len] = '\0'; 90 if ((handle = OF_finddevice(name)) == -1) 91 break; 92 if (OF_getprop(handle, "device_type", type, sizeof(type)) == -1) 93 continue; 94 for (i = 0; (dv = devsw[i]) != NULL; i++) { 95 if (strncmp(dv->dv_name, type, strlen(dv->dv_name)) == 0) 96 goto found; 97 } 98 } 99 return(ENOENT); 100 101found: 102 if (*s != '\0') 103 *path = s; 104 idev = malloc(sizeof(struct ofw_devdesc)); 105 strcpy(idev->d_path, name); 106 idev->d_dev = dv; 107 idev->d_type = dv->dv_type; 108 if (dev == NULL) { 109 free(idev); 110 } else { 111 *dev = idev; 112 } 113 return(0); 114} 115 116int 117ofw_setcurrdev(struct env_var *ev, int flags, const void *value) 118{ 119 struct ofw_devdesc *ncurr; 120 int rv; 121 122 if ((rv = ofw_parsedev(&ncurr, value, NULL)) != 0) 123 return rv; 124 125 free(ncurr); 126 env_setenv(ev->ev_name, flags | EV_NOHOOK, value, NULL, NULL); 127 return 0; 128} 129