subr_device.c revision 1.10 1 1.10 thorpej /* $NetBSD: subr_device.c,v 1.10 2022/01/21 15:55:36 thorpej Exp $ */
2 1.2 pooka
3 1.2 pooka /*
4 1.5 thorpej * Copyright (c) 2006, 2021 The NetBSD Foundation, Inc.
5 1.2 pooka * All rights reserved.
6 1.2 pooka *
7 1.2 pooka * Redistribution and use in source and binary forms, with or without
8 1.2 pooka * modification, are permitted provided that the following conditions
9 1.2 pooka * are met:
10 1.2 pooka * 1. Redistributions of source code must retain the above copyright
11 1.2 pooka * notice, this list of conditions and the following disclaimer.
12 1.2 pooka * 2. Redistributions in binary form must reproduce the above copyright
13 1.2 pooka * notice, this list of conditions and the following disclaimer in the
14 1.2 pooka * documentation and/or other materials provided with the distribution.
15 1.2 pooka *
16 1.2 pooka * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.2 pooka * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.2 pooka * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.2 pooka * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.2 pooka * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.2 pooka * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.2 pooka * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.2 pooka * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.2 pooka * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.2 pooka * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.2 pooka * POSSIBILITY OF SUCH DAMAGE.
27 1.2 pooka */
28 1.2 pooka
29 1.2 pooka #include <sys/cdefs.h>
30 1.10 thorpej __KERNEL_RCSID(0, "$NetBSD: subr_device.c,v 1.10 2022/01/21 15:55:36 thorpej Exp $");
31 1.2 pooka
32 1.2 pooka #include <sys/param.h>
33 1.2 pooka #include <sys/device.h>
34 1.2 pooka #include <sys/systm.h>
35 1.2 pooka
36 1.9 thorpej #include <sys/device_calls.h>
37 1.9 thorpej
38 1.3 pooka /* Root device. */
39 1.3 pooka device_t root_device;
40 1.3 pooka
41 1.2 pooka /*
42 1.7 thorpej * devhandle_t accessors / mutators.
43 1.6 thorpej */
44 1.6 thorpej
45 1.6 thorpej static bool
46 1.6 thorpej devhandle_is_valid_internal(const devhandle_t * const handlep)
47 1.6 thorpej {
48 1.6 thorpej if (handlep->impl == NULL) {
49 1.6 thorpej return false;
50 1.6 thorpej }
51 1.6 thorpej return handlep->impl->type != DEVHANDLE_TYPE_INVALID;
52 1.6 thorpej }
53 1.6 thorpej
54 1.6 thorpej bool
55 1.6 thorpej devhandle_is_valid(devhandle_t handle)
56 1.6 thorpej {
57 1.6 thorpej return devhandle_is_valid_internal(&handle);
58 1.6 thorpej }
59 1.6 thorpej
60 1.10 thorpej devhandle_t
61 1.10 thorpej devhandle_invalid(void)
62 1.6 thorpej {
63 1.10 thorpej static const devhandle_t invalid_devhandle = {
64 1.10 thorpej .impl = NULL,
65 1.10 thorpej .uintptr = 0,
66 1.10 thorpej };
67 1.10 thorpej return invalid_devhandle;
68 1.6 thorpej }
69 1.6 thorpej
70 1.6 thorpej devhandle_type_t
71 1.6 thorpej devhandle_type(devhandle_t handle)
72 1.6 thorpej {
73 1.6 thorpej if (!devhandle_is_valid_internal(&handle)) {
74 1.6 thorpej return DEVHANDLE_TYPE_INVALID;
75 1.6 thorpej }
76 1.6 thorpej
77 1.6 thorpej return handle.impl->type;
78 1.6 thorpej }
79 1.6 thorpej
80 1.8 thorpej device_call_t
81 1.6 thorpej devhandle_lookup_device_call(devhandle_t handle, const char *name,
82 1.6 thorpej devhandle_t *call_handlep)
83 1.6 thorpej {
84 1.6 thorpej const struct devhandle_impl *impl;
85 1.6 thorpej device_call_t call;
86 1.6 thorpej
87 1.6 thorpej /*
88 1.6 thorpej * The back-end can override the handle to use for the call,
89 1.6 thorpej * if needed.
90 1.6 thorpej */
91 1.6 thorpej *call_handlep = handle;
92 1.6 thorpej
93 1.6 thorpej for (impl = handle.impl; impl != NULL; impl = impl->super) {
94 1.6 thorpej if (impl->lookup_device_call != NULL) {
95 1.6 thorpej call = impl->lookup_device_call(handle, name,
96 1.6 thorpej call_handlep);
97 1.6 thorpej if (call != NULL) {
98 1.6 thorpej return call;
99 1.6 thorpej }
100 1.6 thorpej }
101 1.6 thorpej }
102 1.6 thorpej return NULL;
103 1.6 thorpej }
104 1.6 thorpej
105 1.6 thorpej void
106 1.6 thorpej devhandle_impl_inherit(struct devhandle_impl *impl,
107 1.6 thorpej const struct devhandle_impl *super)
108 1.6 thorpej {
109 1.6 thorpej memcpy(impl, super, sizeof(*impl));
110 1.6 thorpej impl->super = super;
111 1.6 thorpej }
112 1.6 thorpej
113 1.6 thorpej /*
114 1.2 pooka * Accessor functions for the device_t type.
115 1.2 pooka */
116 1.5 thorpej
117 1.2 pooka devclass_t
118 1.2 pooka device_class(device_t dev)
119 1.2 pooka {
120 1.2 pooka
121 1.2 pooka return dev->dv_class;
122 1.2 pooka }
123 1.2 pooka
124 1.2 pooka cfdata_t
125 1.2 pooka device_cfdata(device_t dev)
126 1.2 pooka {
127 1.2 pooka
128 1.2 pooka return dev->dv_cfdata;
129 1.2 pooka }
130 1.2 pooka
131 1.2 pooka cfdriver_t
132 1.2 pooka device_cfdriver(device_t dev)
133 1.2 pooka {
134 1.2 pooka
135 1.2 pooka return dev->dv_cfdriver;
136 1.2 pooka }
137 1.2 pooka
138 1.2 pooka cfattach_t
139 1.2 pooka device_cfattach(device_t dev)
140 1.2 pooka {
141 1.2 pooka
142 1.2 pooka return dev->dv_cfattach;
143 1.2 pooka }
144 1.2 pooka
145 1.2 pooka int
146 1.2 pooka device_unit(device_t dev)
147 1.2 pooka {
148 1.2 pooka
149 1.2 pooka return dev->dv_unit;
150 1.2 pooka }
151 1.2 pooka
152 1.2 pooka const char *
153 1.2 pooka device_xname(device_t dev)
154 1.2 pooka {
155 1.2 pooka
156 1.2 pooka return dev->dv_xname;
157 1.2 pooka }
158 1.2 pooka
159 1.2 pooka device_t
160 1.2 pooka device_parent(device_t dev)
161 1.2 pooka {
162 1.2 pooka
163 1.2 pooka return dev->dv_parent;
164 1.2 pooka }
165 1.2 pooka
166 1.2 pooka bool
167 1.2 pooka device_activation(device_t dev, devact_level_t level)
168 1.2 pooka {
169 1.2 pooka int active_flags;
170 1.2 pooka
171 1.2 pooka active_flags = DVF_ACTIVE;
172 1.2 pooka switch (level) {
173 1.2 pooka case DEVACT_LEVEL_FULL:
174 1.2 pooka active_flags |= DVF_CLASS_SUSPENDED;
175 1.2 pooka /*FALLTHROUGH*/
176 1.2 pooka case DEVACT_LEVEL_DRIVER:
177 1.2 pooka active_flags |= DVF_DRIVER_SUSPENDED;
178 1.2 pooka /*FALLTHROUGH*/
179 1.2 pooka case DEVACT_LEVEL_BUS:
180 1.2 pooka active_flags |= DVF_BUS_SUSPENDED;
181 1.2 pooka break;
182 1.2 pooka }
183 1.2 pooka
184 1.2 pooka return (dev->dv_flags & active_flags) == DVF_ACTIVE;
185 1.2 pooka }
186 1.2 pooka
187 1.2 pooka bool
188 1.2 pooka device_is_active(device_t dev)
189 1.2 pooka {
190 1.2 pooka int active_flags;
191 1.2 pooka
192 1.2 pooka active_flags = DVF_ACTIVE;
193 1.2 pooka active_flags |= DVF_CLASS_SUSPENDED;
194 1.2 pooka active_flags |= DVF_DRIVER_SUSPENDED;
195 1.2 pooka active_flags |= DVF_BUS_SUSPENDED;
196 1.2 pooka
197 1.2 pooka return (dev->dv_flags & active_flags) == DVF_ACTIVE;
198 1.2 pooka }
199 1.2 pooka
200 1.2 pooka bool
201 1.2 pooka device_is_enabled(device_t dev)
202 1.2 pooka {
203 1.2 pooka return (dev->dv_flags & DVF_ACTIVE) == DVF_ACTIVE;
204 1.2 pooka }
205 1.2 pooka
206 1.2 pooka bool
207 1.2 pooka device_has_power(device_t dev)
208 1.2 pooka {
209 1.2 pooka int active_flags;
210 1.2 pooka
211 1.2 pooka active_flags = DVF_ACTIVE | DVF_BUS_SUSPENDED;
212 1.2 pooka
213 1.2 pooka return (dev->dv_flags & active_flags) == DVF_ACTIVE;
214 1.2 pooka }
215 1.2 pooka
216 1.2 pooka int
217 1.2 pooka device_locator(device_t dev, u_int locnum)
218 1.2 pooka {
219 1.2 pooka
220 1.2 pooka KASSERT(dev->dv_locators != NULL);
221 1.2 pooka return dev->dv_locators[locnum];
222 1.2 pooka }
223 1.2 pooka
224 1.2 pooka void *
225 1.2 pooka device_private(device_t dev)
226 1.2 pooka {
227 1.2 pooka
228 1.2 pooka /*
229 1.2 pooka * The reason why device_private(NULL) is allowed is to simplify the
230 1.2 pooka * work of a lot of userspace request handlers (i.e., c/bdev
231 1.2 pooka * handlers) which grab cfdriver_t->cd_units[n].
232 1.2 pooka * It avoids having them test for it to be NULL and only then calling
233 1.2 pooka * device_private.
234 1.2 pooka */
235 1.2 pooka return dev == NULL ? NULL : dev->dv_private;
236 1.2 pooka }
237 1.2 pooka
238 1.2 pooka prop_dictionary_t
239 1.2 pooka device_properties(device_t dev)
240 1.2 pooka {
241 1.2 pooka
242 1.2 pooka return dev->dv_properties;
243 1.2 pooka }
244 1.2 pooka
245 1.2 pooka /*
246 1.2 pooka * device_is_a:
247 1.2 pooka *
248 1.2 pooka * Returns true if the device is an instance of the specified
249 1.2 pooka * driver.
250 1.2 pooka */
251 1.2 pooka bool
252 1.2 pooka device_is_a(device_t dev, const char *dname)
253 1.2 pooka {
254 1.4 thorpej if (dev == NULL || dev->dv_cfdriver == NULL) {
255 1.4 thorpej return false;
256 1.4 thorpej }
257 1.2 pooka
258 1.2 pooka return strcmp(dev->dv_cfdriver->cd_name, dname) == 0;
259 1.2 pooka }
260 1.5 thorpej
261 1.5 thorpej /*
262 1.5 thorpej * device_attached_to_iattr:
263 1.5 thorpej *
264 1.5 thorpej * Returns true if the device attached to the specified interface
265 1.5 thorpej * attribute.
266 1.5 thorpej */
267 1.5 thorpej bool
268 1.5 thorpej device_attached_to_iattr(device_t dev, const char *iattr)
269 1.5 thorpej {
270 1.5 thorpej cfdata_t cfdata = device_cfdata(dev);
271 1.5 thorpej const struct cfparent *pspec;
272 1.5 thorpej
273 1.5 thorpej if (cfdata == NULL || (pspec = cfdata->cf_pspec) == NULL) {
274 1.5 thorpej return false;
275 1.5 thorpej }
276 1.5 thorpej
277 1.5 thorpej return strcmp(pspec->cfp_iattr, iattr) == 0;
278 1.5 thorpej }
279 1.6 thorpej
280 1.6 thorpej void
281 1.6 thorpej device_set_handle(device_t dev, devhandle_t handle)
282 1.6 thorpej {
283 1.6 thorpej dev->dv_handle = handle;
284 1.6 thorpej }
285 1.6 thorpej
286 1.6 thorpej devhandle_t
287 1.6 thorpej device_handle(device_t dev)
288 1.6 thorpej {
289 1.6 thorpej return dev->dv_handle;
290 1.6 thorpej }
291 1.6 thorpej
292 1.6 thorpej int
293 1.9 thorpej device_call_generic(device_t dev, const struct device_call_generic *gen)
294 1.6 thorpej {
295 1.6 thorpej devhandle_t handle = device_handle(dev);
296 1.6 thorpej device_call_t call;
297 1.6 thorpej devhandle_t call_handle;
298 1.6 thorpej
299 1.9 thorpej call = devhandle_lookup_device_call(handle, gen->name, &call_handle);
300 1.6 thorpej if (call == NULL) {
301 1.6 thorpej return ENOTSUP;
302 1.6 thorpej }
303 1.9 thorpej return call(dev, call_handle, gen->args);
304 1.6 thorpej }
305 1.6 thorpej
306 1.6 thorpej int
307 1.6 thorpej device_enumerate_children(device_t dev,
308 1.6 thorpej bool (*callback)(device_t, devhandle_t, void *),
309 1.6 thorpej void *callback_arg)
310 1.6 thorpej {
311 1.6 thorpej struct device_enumerate_children_args args = {
312 1.6 thorpej .callback = callback,
313 1.6 thorpej .callback_arg = callback_arg,
314 1.6 thorpej };
315 1.6 thorpej
316 1.9 thorpej return device_call(dev, DEVICE_ENUMERATE_CHILDREN(&args));
317 1.6 thorpej }
318