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