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 #include <stand.h>
29
30 #include "bootstrap.h"
31 #include "libofw.h"
32
33 /*
34 * Point (dev) at an allocated device specifier for the device matching the
35 * path in (devspec). If it contains an explicit device specification,
36 * use that. If not, use the default device.
37 */
38 int
ofw_getdev(void ** vdev,const char * devspec,const char ** path)39 ofw_getdev(void **vdev, const char *devspec, const char **path)
40 {
41 struct devdesc **dev = (struct devdesc **)vdev;
42 int rv;
43
44 /*
45 * If it looks like this is just a path and no device, go with the
46 * current device.
47 */
48 if (devspec == NULL || strpbrk(devspec, ":@") == NULL) {
49 rv = devparse(dev, getenv("currdev"), NULL);
50 if (rv == 0 && path != NULL)
51 *path = devspec;
52 return (rv);
53 }
54
55 /*
56 * Try to parse the device name off the beginning of the devspec
57 */
58 return (devparse(dev, devspec, path));
59 }
60
61 /*
62 * Search the OFW (path) for a node that's of (want_type).
63 */
64 phandle_t
ofw_path_to_handle(const char * ofwpath,const char * want_type,const char ** path)65 ofw_path_to_handle(const char *ofwpath, const char *want_type, const char **path)
66 {
67 const char *p, *s;
68 char name[256];
69 char type[64];
70 phandle_t handle;
71 int len;
72
73 for (p = s = ofwpath; *s != '\0'; p = s) {
74 if ((s = strchr(p + 1, '/')) == NULL)
75 s = strchr(p, '\0');
76 len = s - ofwpath;
77 if (len >= sizeof(name))
78 return ((phandle_t)-1);
79 bcopy(ofwpath, name, len);
80 name[len] = '\0';
81 if ((handle = OF_finddevice(name)) == -1)
82 continue;
83 if (OF_getprop(handle, "device_type", type, sizeof(type)) == -1)
84 continue;
85 if (strcmp(want_type, type) == 0) {
86 *path = s;
87 return (handle);
88 }
89 }
90 return ((phandle_t)-1);
91 }
92
93 int
ofw_common_parsedev(struct devdesc ** dev,const char * devspec,const char ** path,const char * ofwtype)94 ofw_common_parsedev(struct devdesc **dev, const char *devspec, const char **path,
95 const char *ofwtype)
96 {
97 const char *rem_path;
98 struct ofw_devdesc *idev;
99
100 if (ofw_path_to_handle(devspec, ofwtype, &rem_path) == -1)
101 return (ENOENT);
102 idev = malloc(sizeof(struct ofw_devdesc));
103 if (idev == NULL) {
104 printf("ofw_parsedev: malloc failed\n");
105 return ENOMEM;
106 };
107 strlcpy(idev->d_path, devspec, min(rem_path - devspec + 1,
108 sizeof(idev->d_path)));
109 *dev = &idev->dd;
110 if (path != NULL)
111 *path = rem_path;
112 return 0;
113 }
114