devicename.c revision 151649
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 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD: head/sys/boot/ofw/libofw/devicename.c 151649 2005-10-25 12:49:56Z marius $"); 29 30#include <stand.h> 31#include "libofw.h" 32 33static int ofw_parsedev(struct ofw_devdesc **, const char *, const char **); 34 35/* 36 * Point (dev) at an allocated device specifier for the device matching the 37 * path in (devspec). If it contains an explicit device specification, 38 * use that. If not, use the default device. 39 */ 40int 41ofw_getdev(void **vdev, const char *devspec, const char **path) 42{ 43 struct ofw_devdesc **dev = (struct ofw_devdesc **)vdev; 44 int rv; 45 46 /* 47 * If it looks like this is just a path and no 48 * device, go with the current device. 49 */ 50 if ((devspec == NULL) || 51 ((strchr(devspec, '@') == NULL) && 52 (strchr(devspec, ':') == NULL))) { 53 54 if (((rv = ofw_parsedev(dev, getenv("currdev"), NULL)) == 0) && 55 (path != NULL)) 56 *path = devspec; 57 return(rv); 58 } 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 (path != NULL && *s != '\0') 103 *path = s; 104 idev = malloc(sizeof(struct ofw_devdesc)); 105 if (idev == NULL) { 106 printf("ofw_parsedev: malloc failed\n"); 107 return ENOMEM; 108 } 109 strcpy(idev->d_path, name); 110 idev->d_dev = dv; 111 idev->d_type = dv->dv_type; 112 if (dev == NULL) { 113 free(idev); 114 } else { 115 *dev = idev; 116 } 117 return(0); 118} 119 120int 121ofw_setcurrdev(struct env_var *ev, int flags, const void *value) 122{ 123 struct ofw_devdesc *ncurr; 124 int rv; 125 126 if ((rv = ofw_parsedev(&ncurr, value, NULL)) != 0) 127 return rv; 128 129 free(ncurr); 130 env_setenv(ev->ev_name, flags | EV_NOHOOK, value, NULL, NULL); 131 return 0; 132} 133