subr_device.c revision 1.9 1 1.9 thorpej /* $NetBSD: subr_device.c,v 1.9 2021/09/15 17:33:08 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.9 thorpej __KERNEL_RCSID(0, "$NetBSD: subr_device.c,v 1.9 2021/09/15 17:33:08 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.6 thorpej void
61 1.6 thorpej devhandle_invalidate(devhandle_t * const handlep)
62 1.6 thorpej {
63 1.6 thorpej handlep->impl = NULL;
64 1.6 thorpej handlep->uintptr = 0;
65 1.6 thorpej }
66 1.6 thorpej
67 1.6 thorpej devhandle_type_t
68 1.6 thorpej devhandle_type(devhandle_t handle)
69 1.6 thorpej {
70 1.6 thorpej if (!devhandle_is_valid_internal(&handle)) {
71 1.6 thorpej return DEVHANDLE_TYPE_INVALID;
72 1.6 thorpej }
73 1.6 thorpej
74 1.6 thorpej return handle.impl->type;
75 1.6 thorpej }
76 1.6 thorpej
77 1.8 thorpej device_call_t
78 1.6 thorpej devhandle_lookup_device_call(devhandle_t handle, const char *name,
79 1.6 thorpej devhandle_t *call_handlep)
80 1.6 thorpej {
81 1.6 thorpej const struct devhandle_impl *impl;
82 1.6 thorpej device_call_t call;
83 1.6 thorpej
84 1.6 thorpej /*
85 1.6 thorpej * The back-end can override the handle to use for the call,
86 1.6 thorpej * if needed.
87 1.6 thorpej */
88 1.6 thorpej *call_handlep = handle;
89 1.6 thorpej
90 1.6 thorpej for (impl = handle.impl; impl != NULL; impl = impl->super) {
91 1.6 thorpej if (impl->lookup_device_call != NULL) {
92 1.6 thorpej call = impl->lookup_device_call(handle, name,
93 1.6 thorpej call_handlep);
94 1.6 thorpej if (call != NULL) {
95 1.6 thorpej return call;
96 1.6 thorpej }
97 1.6 thorpej }
98 1.6 thorpej }
99 1.6 thorpej return NULL;
100 1.6 thorpej }
101 1.6 thorpej
102 1.6 thorpej void
103 1.6 thorpej devhandle_impl_inherit(struct devhandle_impl *impl,
104 1.6 thorpej const struct devhandle_impl *super)
105 1.6 thorpej {
106 1.6 thorpej memcpy(impl, super, sizeof(*impl));
107 1.6 thorpej impl->super = super;
108 1.6 thorpej }
109 1.6 thorpej
110 1.6 thorpej /*
111 1.2 pooka * Accessor functions for the device_t type.
112 1.2 pooka */
113 1.5 thorpej
114 1.2 pooka devclass_t
115 1.2 pooka device_class(device_t dev)
116 1.2 pooka {
117 1.2 pooka
118 1.2 pooka return dev->dv_class;
119 1.2 pooka }
120 1.2 pooka
121 1.2 pooka cfdata_t
122 1.2 pooka device_cfdata(device_t dev)
123 1.2 pooka {
124 1.2 pooka
125 1.2 pooka return dev->dv_cfdata;
126 1.2 pooka }
127 1.2 pooka
128 1.2 pooka cfdriver_t
129 1.2 pooka device_cfdriver(device_t dev)
130 1.2 pooka {
131 1.2 pooka
132 1.2 pooka return dev->dv_cfdriver;
133 1.2 pooka }
134 1.2 pooka
135 1.2 pooka cfattach_t
136 1.2 pooka device_cfattach(device_t dev)
137 1.2 pooka {
138 1.2 pooka
139 1.2 pooka return dev->dv_cfattach;
140 1.2 pooka }
141 1.2 pooka
142 1.2 pooka int
143 1.2 pooka device_unit(device_t dev)
144 1.2 pooka {
145 1.2 pooka
146 1.2 pooka return dev->dv_unit;
147 1.2 pooka }
148 1.2 pooka
149 1.2 pooka const char *
150 1.2 pooka device_xname(device_t dev)
151 1.2 pooka {
152 1.2 pooka
153 1.2 pooka return dev->dv_xname;
154 1.2 pooka }
155 1.2 pooka
156 1.2 pooka device_t
157 1.2 pooka device_parent(device_t dev)
158 1.2 pooka {
159 1.2 pooka
160 1.2 pooka return dev->dv_parent;
161 1.2 pooka }
162 1.2 pooka
163 1.2 pooka bool
164 1.2 pooka device_activation(device_t dev, devact_level_t level)
165 1.2 pooka {
166 1.2 pooka int active_flags;
167 1.2 pooka
168 1.2 pooka active_flags = DVF_ACTIVE;
169 1.2 pooka switch (level) {
170 1.2 pooka case DEVACT_LEVEL_FULL:
171 1.2 pooka active_flags |= DVF_CLASS_SUSPENDED;
172 1.2 pooka /*FALLTHROUGH*/
173 1.2 pooka case DEVACT_LEVEL_DRIVER:
174 1.2 pooka active_flags |= DVF_DRIVER_SUSPENDED;
175 1.2 pooka /*FALLTHROUGH*/
176 1.2 pooka case DEVACT_LEVEL_BUS:
177 1.2 pooka active_flags |= DVF_BUS_SUSPENDED;
178 1.2 pooka break;
179 1.2 pooka }
180 1.2 pooka
181 1.2 pooka return (dev->dv_flags & active_flags) == DVF_ACTIVE;
182 1.2 pooka }
183 1.2 pooka
184 1.2 pooka bool
185 1.2 pooka device_is_active(device_t dev)
186 1.2 pooka {
187 1.2 pooka int active_flags;
188 1.2 pooka
189 1.2 pooka active_flags = DVF_ACTIVE;
190 1.2 pooka active_flags |= DVF_CLASS_SUSPENDED;
191 1.2 pooka active_flags |= DVF_DRIVER_SUSPENDED;
192 1.2 pooka active_flags |= DVF_BUS_SUSPENDED;
193 1.2 pooka
194 1.2 pooka return (dev->dv_flags & active_flags) == DVF_ACTIVE;
195 1.2 pooka }
196 1.2 pooka
197 1.2 pooka bool
198 1.2 pooka device_is_enabled(device_t dev)
199 1.2 pooka {
200 1.2 pooka return (dev->dv_flags & DVF_ACTIVE) == DVF_ACTIVE;
201 1.2 pooka }
202 1.2 pooka
203 1.2 pooka bool
204 1.2 pooka device_has_power(device_t dev)
205 1.2 pooka {
206 1.2 pooka int active_flags;
207 1.2 pooka
208 1.2 pooka active_flags = DVF_ACTIVE | DVF_BUS_SUSPENDED;
209 1.2 pooka
210 1.2 pooka return (dev->dv_flags & active_flags) == DVF_ACTIVE;
211 1.2 pooka }
212 1.2 pooka
213 1.2 pooka int
214 1.2 pooka device_locator(device_t dev, u_int locnum)
215 1.2 pooka {
216 1.2 pooka
217 1.2 pooka KASSERT(dev->dv_locators != NULL);
218 1.2 pooka return dev->dv_locators[locnum];
219 1.2 pooka }
220 1.2 pooka
221 1.2 pooka void *
222 1.2 pooka device_private(device_t dev)
223 1.2 pooka {
224 1.2 pooka
225 1.2 pooka /*
226 1.2 pooka * The reason why device_private(NULL) is allowed is to simplify the
227 1.2 pooka * work of a lot of userspace request handlers (i.e., c/bdev
228 1.2 pooka * handlers) which grab cfdriver_t->cd_units[n].
229 1.2 pooka * It avoids having them test for it to be NULL and only then calling
230 1.2 pooka * device_private.
231 1.2 pooka */
232 1.2 pooka return dev == NULL ? NULL : dev->dv_private;
233 1.2 pooka }
234 1.2 pooka
235 1.2 pooka prop_dictionary_t
236 1.2 pooka device_properties(device_t dev)
237 1.2 pooka {
238 1.2 pooka
239 1.2 pooka return dev->dv_properties;
240 1.2 pooka }
241 1.2 pooka
242 1.2 pooka /*
243 1.2 pooka * device_is_a:
244 1.2 pooka *
245 1.2 pooka * Returns true if the device is an instance of the specified
246 1.2 pooka * driver.
247 1.2 pooka */
248 1.2 pooka bool
249 1.2 pooka device_is_a(device_t dev, const char *dname)
250 1.2 pooka {
251 1.4 thorpej if (dev == NULL || dev->dv_cfdriver == NULL) {
252 1.4 thorpej return false;
253 1.4 thorpej }
254 1.2 pooka
255 1.2 pooka return strcmp(dev->dv_cfdriver->cd_name, dname) == 0;
256 1.2 pooka }
257 1.5 thorpej
258 1.5 thorpej /*
259 1.5 thorpej * device_attached_to_iattr:
260 1.5 thorpej *
261 1.5 thorpej * Returns true if the device attached to the specified interface
262 1.5 thorpej * attribute.
263 1.5 thorpej */
264 1.5 thorpej bool
265 1.5 thorpej device_attached_to_iattr(device_t dev, const char *iattr)
266 1.5 thorpej {
267 1.5 thorpej cfdata_t cfdata = device_cfdata(dev);
268 1.5 thorpej const struct cfparent *pspec;
269 1.5 thorpej
270 1.5 thorpej if (cfdata == NULL || (pspec = cfdata->cf_pspec) == NULL) {
271 1.5 thorpej return false;
272 1.5 thorpej }
273 1.5 thorpej
274 1.5 thorpej return strcmp(pspec->cfp_iattr, iattr) == 0;
275 1.5 thorpej }
276 1.6 thorpej
277 1.6 thorpej void
278 1.6 thorpej device_set_handle(device_t dev, devhandle_t handle)
279 1.6 thorpej {
280 1.6 thorpej dev->dv_handle = handle;
281 1.6 thorpej }
282 1.6 thorpej
283 1.6 thorpej devhandle_t
284 1.6 thorpej device_handle(device_t dev)
285 1.6 thorpej {
286 1.6 thorpej return dev->dv_handle;
287 1.6 thorpej }
288 1.6 thorpej
289 1.6 thorpej int
290 1.9 thorpej device_call_generic(device_t dev, const struct device_call_generic *gen)
291 1.6 thorpej {
292 1.6 thorpej devhandle_t handle = device_handle(dev);
293 1.6 thorpej device_call_t call;
294 1.6 thorpej devhandle_t call_handle;
295 1.6 thorpej
296 1.9 thorpej call = devhandle_lookup_device_call(handle, gen->name, &call_handle);
297 1.6 thorpej if (call == NULL) {
298 1.6 thorpej return ENOTSUP;
299 1.6 thorpej }
300 1.9 thorpej return call(dev, call_handle, gen->args);
301 1.6 thorpej }
302 1.6 thorpej
303 1.6 thorpej int
304 1.6 thorpej device_enumerate_children(device_t dev,
305 1.6 thorpej bool (*callback)(device_t, devhandle_t, void *),
306 1.6 thorpej void *callback_arg)
307 1.6 thorpej {
308 1.6 thorpej struct device_enumerate_children_args args = {
309 1.6 thorpej .callback = callback,
310 1.6 thorpej .callback_arg = callback_arg,
311 1.6 thorpej };
312 1.6 thorpej
313 1.9 thorpej return device_call(dev, DEVICE_ENUMERATE_CHILDREN(&args));
314 1.6 thorpej }
315