#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: subr_device.c,v 1.21 2026/05/26 14:50:52 simonb Exp $");
#include <sys/param.h>
#include <sys/types.h>
#include <sys/device.h>
#include <sys/device_calls.h>
#include <sys/device_impl.h>
#include <sys/kmem.h>
#include <sys/sdt.h>
#include <sys/systm.h>
device_t root_device;
static bool
devhandle_is_valid_internal(const devhandle_t * const handlep)
{
if (handlep->impl == NULL) {
return false;
}
return handlep->impl->type != DEVHANDLE_TYPE_INVALID;
}
bool
devhandle_is_valid(devhandle_t handle)
{
return devhandle_is_valid_internal(&handle);
}
devhandle_t
devhandle_invalid(void)
{
static const devhandle_t invalid_devhandle = {
.impl = NULL,
.uintptr = 0,
};
return invalid_devhandle;
}
devhandle_type_t
devhandle_type(devhandle_t handle)
{
if (!devhandle_is_valid_internal(&handle)) {
return DEVHANDLE_TYPE_INVALID;
}
return handle.impl->type;
}
int
devhandle_compare(devhandle_t handle1, devhandle_t handle2)
{
devhandle_type_t type1 = devhandle_type(handle1);
devhandle_type_t type2 = devhandle_type(handle2);
if (type1 == DEVHANDLE_TYPE_INVALID) {
return -1;
}
if (type2 == DEVHANDLE_TYPE_INVALID) {
return 1;
}
if (type1 < type2) {
return -1;
}
if (type1 > type2) {
return 1;
}
if (type1 == DEVHANDLE_TYPE_PRIVATE) {
intptr_t impl1 = (intptr_t)handle1.impl;
intptr_t impl2 = (intptr_t)handle2.impl;
if (impl1 < impl2) {
return -1;
}
if (impl1 > impl2) {
return 1;
}
}
if (handle1.integer < handle2.integer) {
return -1;
}
if (handle1.integer > handle2.integer) {
return 1;
}
return 0;
}
static const struct device_call_descriptor sysdflt_dummy_descriptor;
_DEVICE_CALL_REGISTER(sysdflt_device_calls, sysdflt_dummy)
static device_call_t
sysdflt_lookup_device_call(devhandle_t handle, const char *name,
devhandle_t *call_handlep)
{
__link_set_decl(sysdflt_device_calls, struct device_call_descriptor);
struct device_call_descriptor * const *desc;
__link_set_foreach(desc, sysdflt_device_calls) {
if ((*desc)->name != NULL &&
strcmp((*desc)->name, name) == 0) {
return (*desc)->call;
}
}
return NULL;
}
device_call_t
devhandle_lookup_device_call(devhandle_t handle, const char *name,
devhandle_t *call_handlep)
{
const struct devhandle_impl *impl;
device_call_t call;
*call_handlep = handle;
for (impl = handle.impl; impl != NULL; impl = impl->super) {
if (impl->lookup_device_call != NULL) {
call = impl->lookup_device_call(handle, name,
call_handlep);
if (call != NULL) {
return call;
}
}
}
return sysdflt_lookup_device_call(handle, name, call_handlep);
}
void
devhandle_impl_subclass(struct devhandle_impl *new_impl,
const struct devhandle_impl *super,
device_call_t (*new_lookup)(devhandle_t, const char *, devhandle_t *))
{
new_impl->type = super->type;
new_impl->super = super;
new_impl->lookup_device_call = new_lookup;
}
devhandle_t
devhandle_subclass(devhandle_t handle,
struct devhandle_impl *new_impl,
device_call_t (*new_lookup)(devhandle_t, const char *, devhandle_t *))
{
devhandle_impl_subclass(new_impl, handle.impl, new_lookup);
handle.impl = new_impl;
return handle;
}
devclass_t
device_class(device_t dev)
{
return dev->dv_class;
}
cfdata_t
device_cfdata(device_t dev)
{
return dev->dv_cfdata;
}
cfdriver_t
device_cfdriver(device_t dev)
{
return dev->dv_cfdriver;
}
cfattach_t
device_cfattach(device_t dev)
{
return dev->dv_cfattach;
}
int
device_unit(device_t dev)
{
return dev->dv_unit;
}
const char *
device_xname(device_t dev)
{
return dev->dv_xname;
}
device_t
device_parent(device_t dev)
{
return dev->dv_parent;
}
bool
device_activation(device_t dev, devact_level_t level)
{
int active_flags;
active_flags = DVF_ACTIVE;
switch (level) {
case DEVACT_LEVEL_FULL:
active_flags |= DVF_CLASS_SUSPENDED;
case DEVACT_LEVEL_DRIVER:
active_flags |= DVF_DRIVER_SUSPENDED;
case DEVACT_LEVEL_BUS:
active_flags |= DVF_BUS_SUSPENDED;
break;
}
return (dev->dv_flags & active_flags) == DVF_ACTIVE;
}
bool
device_is_active(device_t dev)
{
int active_flags;
active_flags = DVF_ACTIVE;
active_flags |= DVF_CLASS_SUSPENDED;
active_flags |= DVF_DRIVER_SUSPENDED;
active_flags |= DVF_BUS_SUSPENDED;
return (dev->dv_flags & active_flags) == DVF_ACTIVE;
}
bool
device_is_enabled(device_t dev)
{
return (dev->dv_flags & DVF_ACTIVE) == DVF_ACTIVE;
}
bool
device_has_partitions(device_t dev)
{
return device_class((dev)) == DV_DISK &&
!(dev->dv_flags & DVF_NO_PARTITIONS);
}
bool
device_has_power(device_t dev)
{
int active_flags;
active_flags = DVF_ACTIVE | DVF_BUS_SUSPENDED;
return (dev->dv_flags & active_flags) == DVF_ACTIVE;
}
int
device_locator(device_t dev, u_int locnum)
{
KASSERT(dev->dv_locators != NULL);
return dev->dv_locators[locnum];
}
void *
device_private(device_t dev)
{
return dev == NULL ? NULL : dev->dv_private;
}
void
device_set_private(device_t dev, void *private)
{
KASSERTMSG(dev->dv_private == NULL, "device_set_private(%p, %p):"
" device %s already has private set to %p",
dev, private, device_xname(dev), device_private(dev));
KASSERT(private != NULL);
dev->dv_private = private;
}
prop_dictionary_t
device_properties(device_t dev)
{
return dev->dv_properties;
}
bool
device_is_a(device_t dev, const char *dname)
{
if (dev == NULL || dev->dv_cfdriver == NULL) {
return false;
}
return strcmp(dev->dv_cfdriver->cd_name, dname) == 0;
}
bool
device_attached_to_iattr(device_t dev, const char *iattr)
{
cfdata_t cfdata = device_cfdata(dev);
const struct cfparent *pspec;
if (cfdata == NULL || (pspec = cfdata->cf_pspec) == NULL) {
return false;
}
return strcmp(pspec->cfp_iattr, iattr) == 0;
}
void
device_set_handle(device_t dev, devhandle_t handle)
{
dev->dv_handle = handle;
}
devhandle_t
device_handle(device_t dev)
{
return dev->dv_handle;
}
int
device_call_generic(device_t dev, devhandle_t handle,
const struct device_call_generic *gen)
{
device_call_t call;
devhandle_t call_handle;
call = devhandle_lookup_device_call(handle, gen->name, &call_handle);
if (call == NULL) {
return SET_ERROR(ENOTSUP);
}
return call(dev, call_handle, gen->args);
}
int
device_enumerate_children(device_t dev,
bool (*callback)(device_t, devhandle_t, void *),
void *callback_arg)
{
struct device_enumerate_children_args args = {
.callback = callback,
.callback_arg = callback_arg,
};
return device_call(dev, DEVICE_ENUMERATE_CHILDREN(&args));
}
static int
device_getprop_dict(device_t dev, struct device_get_property_args *args)
{
prop_dictionary_t dict = dev->dv_properties;
prop_object_t propval;
bool rv;
propval = prop_dictionary_get(dict, args->prop);
if (propval == NULL) {
return SET_ERROR(ENOENT);
}
prop_type_t objtype = prop_object_type(propval);
switch (args->reqtype) {
case PROP_TYPE_DATA:
KASSERT(args->buf != NULL);
KASSERT(args->buflen != 0);
if (objtype != PROP_TYPE_DATA && objtype != PROP_TYPE_STRING) {
return SET_ERROR(EFTYPE);
}
break;
case PROP_TYPE_UNKNOWN:
KASSERT(args->buf == NULL);
KASSERT(args->buflen == 0);
break;
default:
KASSERT(args->buf != NULL);
KASSERT(args->buflen != 0);
if (args->reqtype != objtype) {
return SET_ERROR(EFTYPE);
}
}
args->encoding = _BYTE_ORDER;
args->type = objtype;
switch (args->type) {
case PROP_TYPE_NUMBER:
args->propsize = prop_number_size(propval) >> 3;
if (args->buf != NULL) {
KASSERT(args->buflen == sizeof(uint64_t));
if (prop_number_unsigned(propval)) {
rv = prop_number_uint64_value(propval,
args->buf);
} else {
rv = prop_number_int64_value(propval,
args->buf);
}
if (! rv) {
return SET_ERROR(EIO);
}
}
break;
case PROP_TYPE_STRING:
args->propsize = prop_string_size(propval) + 1;
if (args->buf != NULL) {
if (args->buflen < args->propsize) {
return SET_ERROR(EFBIG);
}
strlcpy(args->buf, prop_string_value(propval),
args->buflen);
}
break;
case PROP_TYPE_DATA:
args->propsize = prop_data_size(propval);
if (args->buf != NULL) {
if (args->buflen < args->propsize) {
return SET_ERROR(EFBIG);
}
memcpy(args->buf, prop_data_value(propval),
args->propsize);
}
break;
case PROP_TYPE_BOOL:
args->propsize = sizeof(bool);
if (args->buf != NULL) {
KASSERT(args->buflen == sizeof(bool));
*(bool *)args->buf = prop_bool_value(propval);
}
break;
default:
return SET_ERROR(EFTYPE);
}
return 0;
}
static int
device_getprop_internal(device_t dev, struct device_get_property_args *args)
{
int error;
if (args->buf == NULL || args->buflen == 0) {
args->buf = NULL;
args->buflen = 0;
} else if (args->buflen > SSIZE_MAX) {
args->buflen = SSIZE_MAX;
}
args->propsize = -1;
args->flags = 0;
error = device_getprop_dict(dev, args);
if (error != ENOENT) {
KASSERT(error != 0 ||
args->encoding == _BYTE_ORDER);
goto out;
}
error = device_call(dev, DEVICE_GET_PROPERTY(args));
KASSERT(error != 0 ||
(args->encoding == _BIG_ENDIAN ||
args->encoding == _LITTLE_ENDIAN));
out:
KASSERT(error != EFBIG || args->propsize >= 0);
return error;
}
static ssize_t
device_getprop_buf_internal(device_t dev, const char *prop, void *buf,
size_t buflen, prop_type_t type)
{
struct device_get_property_args args = {
.prop = prop,
.buf = buf,
.buflen = buflen,
.reqtype = type,
};
int error;
KASSERT(type == PROP_TYPE_DATA || type == PROP_TYPE_STRING);
KASSERT(buf != NULL);
KASSERT(buflen != 0);
if (buf == NULL || buflen == 0) {
return -1;
}
error = device_getprop_internal(dev, &args);
if (error) {
return -1;
}
KASSERT(args.buflen <= SSIZE_MAX);
KASSERT(args.propsize <= (ssize_t)args.buflen);
if (args.propsize > args.buflen) {
return -1;
}
return args.propsize;
}
static void *
device_getprop_alloc_internal(device_t dev, const char *prop, size_t *retsizep,
prop_type_t type)
{
struct device_get_property_args args = {
.prop = prop,
.reqtype = type,
};
size_t buflen = 0;
int error;
KASSERT(type == PROP_TYPE_DATA || type == PROP_TYPE_STRING);
error = device_getprop_internal(dev, &args);
if (error) {
return NULL;
}
for (;;) {
if (args.propsize <= 0) {
return NULL;
}
args.buflen = buflen = args.propsize;
args.buf = kmem_alloc(buflen, KM_SLEEP);
error = device_getprop_internal(dev, &args);
if ((error == 0 && (ssize_t)args.buflen == args.propsize) ||
error != EFBIG) {
break;
}
kmem_free(args.buf, buflen);
}
KASSERT(args.buf != NULL);
KASSERT(args.buflen != 0);
if (error) {
kmem_free(args.buf, args.buflen);
args.buf = NULL;
} else if (retsizep != NULL) {
KASSERT(args.buflen == buflen);
KASSERT(args.buflen == args.propsize);
*retsizep = args.buflen;
}
return args.buf;
}
bool
device_hasprop(device_t dev, const char *prop)
{
return device_getproplen(dev, prop) >= 0;
}
ssize_t
device_getproplen(device_t dev, const char *prop)
{
struct device_get_property_args args = {
.prop = prop,
.reqtype = PROP_TYPE_UNKNOWN,
};
int error;
error = device_getprop_internal(dev, &args);
if (error) {
return -1;
}
return args.propsize;
}
int
device_getpropencoding(device_t dev, const char *prop)
{
struct device_get_property_args args = {
.prop = prop,
.reqtype = PROP_TYPE_UNKNOWN,
};
int error;
error = device_getprop_internal(dev, &args);
if (error) {
return -1;
}
return args.encoding;
}
prop_type_t
device_getproptype(device_t dev, const char *prop)
{
struct device_get_property_args args = {
.prop = prop,
.reqtype = PROP_TYPE_UNKNOWN,
};
int error;
error = device_getprop_internal(dev, &args);
if (error) {
return PROP_TYPE_UNKNOWN;
}
return args.type;
}
ssize_t
device_getprop_data(device_t dev, const char *prop, void *buf, size_t buflen)
{
return device_getprop_buf_internal(dev, prop, buf, buflen,
PROP_TYPE_DATA);
}
void *
device_getprop_data_alloc(device_t dev, const char *prop, size_t *retsizep)
{
return device_getprop_alloc_internal(dev, prop, retsizep,
PROP_TYPE_DATA);
}
ssize_t
device_getprop_string(device_t dev, const char *prop, char *buf, size_t buflen)
{
return device_getprop_buf_internal(dev, prop, buf, buflen,
PROP_TYPE_STRING);
}
char *
device_getprop_string_alloc(device_t dev, const char *prop, size_t *retsizep)
{
return device_getprop_alloc_internal(dev, prop, retsizep,
PROP_TYPE_STRING);
}
bool
device_getprop_bool(device_t dev, const char *prop)
{
bool val;
struct device_get_property_args args = {
.prop = prop,
.buf = &val,
.buflen = sizeof(val),
.reqtype = PROP_TYPE_BOOL,
};
int error;
error = device_getprop_internal(dev, &args);
if (error) {
return error == EFTYPE ? true : false;
}
return val;
}
#define S8_BIT __BIT(7)
#define S8_MASK __BITS(7,63)
#define S16_BIT __BIT(15)
#define S16_MASK __BITS(15,63)
#define S32_BIT __BIT(31)
#define S32_MASK __BITS(31,63)
static bool
device_getprop_number_sext(struct device_get_property_args *args,
uint64_t *valp)
{
uint64_t bit, mask;
switch (args->propsize) {
case 1:
bit = S8_BIT;
mask = S8_MASK;
break;
case 2:
bit = S16_BIT;
mask = S16_MASK;
break;
case 4:
bit = S32_BIT;
mask = S32_MASK;
break;
case 8:
return true;
default:
return false;
}
if ((*valp & mask) == bit) {
*valp |= mask;
} else if ((*valp & mask) != mask) {
return false;
}
return true;
}
#undef S8_BIT
#undef S8_MASK
#undef S16_BIT
#undef S16_MASK
#undef S32_BIT
#undef S32_MASK
static int
device_getprop_int32_internal(device_t dev, const char *prop, int32_t *valp)
{
int64_t val64;
struct device_get_property_args args = {
.prop = prop,
.buf = &val64,
.buflen = sizeof(val64),
.reqtype = PROP_TYPE_NUMBER,
};
int error;
error = device_getprop_internal(dev, &args);
if (error) {
return error;
}
if (! device_getprop_number_sext(&args, (uint64_t *)&val64)) {
return SET_ERROR(ERANGE);
}
if (val64 < INT32_MIN || val64 > INT32_MAX) {
return SET_ERROR(ERANGE);
}
*valp = (int32_t)val64;
return 0;
}
static int
device_getprop_uint32_internal(device_t dev, const char *prop, uint32_t *valp)
{
uint64_t val64;
struct device_get_property_args args = {
.prop = prop,
.buf = &val64,
.buflen = sizeof(val64),
.reqtype = PROP_TYPE_NUMBER,
};
int error;
error = device_getprop_internal(dev, &args);
if (error) {
return error;
}
if (val64 > UINT32_MAX) {
return SET_ERROR(ERANGE);
}
*valp = (uint32_t)val64;
return 0;
}
static int
device_getprop_int64_internal(device_t dev, const char *prop, int64_t *valp)
{
int64_t val64;
struct device_get_property_args args = {
.prop = prop,
.buf = &val64,
.buflen = sizeof(val64),
.reqtype = PROP_TYPE_NUMBER,
};
int error;
error = device_getprop_internal(dev, &args);
if (error) {
return error;
}
if (! device_getprop_number_sext(&args, &val64)) {
return SET_ERROR(ERANGE);
}
*valp = val64;
return 0;
}
static int
device_getprop_uint64_internal(device_t dev, const char *prop, uint64_t *valp)
{
struct device_get_property_args args = {
.prop = prop,
.buf = valp,
.buflen = sizeof(*valp),
.reqtype = PROP_TYPE_NUMBER,
};
return device_getprop_internal(dev, &args);
}
#define TEMPLATE(name) \
bool \
device_getprop_ ## name (device_t dev, const char *prop, \
name ## _t *valp) \
{ \
return device_getprop_ ## name ## _internal(dev, prop, valp) \
== 0; \
} \
\
name ## _t \
device_getprop_ ## name ## _default(device_t dev, const char *prop, \
name ## _t defval) \
{ \
name ## _t val; \
\
return device_getprop_ ## name ## _internal(dev, prop, &val) \
? defval : val; \
}
TEMPLATE(int32)
__strong_alias(device_getprop_int,device_getprop_int32);
__strong_alias(device_getprop_int_default,device_getprop_int32_default);
TEMPLATE(uint32)
__strong_alias(device_getprop_uint,device_getprop_uint32);
__strong_alias(device_getprop_uint_default,device_getprop_uint32_default);
TEMPLATE(int64)
TEMPLATE(uint64)
#undef TEMPLATE
bool
device_setprop_data(device_t dev, const char *prop, const void *buf, size_t len)
{
return prop_dictionary_set_data(dev->dv_properties, prop, buf, len);
}
bool
device_setprop_string(device_t dev, const char *prop, const char *str)
{
return prop_dictionary_set_string(dev->dv_properties, prop, str);
}
bool
device_setprop_bool(device_t dev, const char *prop, bool val)
{
return prop_dictionary_set_bool(dev->dv_properties, prop, val);
}
bool
device_setprop_int32(device_t dev, const char *prop, int32_t val)
{
return prop_dictionary_set_int32(dev->dv_properties, prop, val);
}
__strong_alias(device_setprop_int,device_setprop_int32);
bool
device_setprop_uint32(device_t dev, const char *prop, uint32_t val)
{
return prop_dictionary_set_uint32(dev->dv_properties, prop, val);
}
__strong_alias(device_setprop_uint,device_setprop_uint32);
bool
device_setprop_int64(device_t dev, const char *prop, int64_t val)
{
return prop_dictionary_set_int64(dev->dv_properties, prop, val);
}
bool
device_setprop_uint64(device_t dev, const char *prop, uint64_t val)
{
return prop_dictionary_set_uint64(dev->dv_properties, prop, val);
}
void
device_delprop(device_t dev, const char *prop)
{
prop_dictionary_remove(dev->dv_properties, prop);
}