Home | History | Annotate | Line # | Download | only in kern
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