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