Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 | /* * Copyright (c) 2015-2016 Intel Corporation. * * SPDX-License-Identifier: Apache-2.0 */ #include <string.h> #include <zephyr/device.h> #include <zephyr/sys/atomic.h> #include <zephyr/sys/iterable_sections.h> #include <zephyr/sys/kobject.h> #include <zephyr/internal/syscall_handler.h> #include <zephyr/toolchain.h> /** * @brief Initialize state for all static devices. * * The state object is always zero-initialized, but this may not be * sufficient. */ void z_device_state_init(void) { STRUCT_SECTION_FOREACH(device, dev) { k_object_init(dev); } } const struct device *z_impl_device_get_binding(const char *name) { /* A null string identifies no device. So does an empty * string. */ if ((name == NULL) || (name[0] == '\0')) { return NULL; } /* Split the search into two loops: in the common scenario, where * device names are stored in ROM (and are referenced by the user * with CONFIG_* macros), only cheap pointer comparisons will be * performed. Reserve string comparisons for a fallback. */ STRUCT_SECTION_FOREACH(device, dev) { if (z_device_is_ready(dev) && (dev->name == name)) { return dev; } } STRUCT_SECTION_FOREACH(device, dev) { if (z_device_is_ready(dev) && (strcmp(name, dev->name) == 0)) { return dev; } } return NULL; } #ifdef CONFIG_USERSPACE static inline const struct device *z_vrfy_device_get_binding(const char *name) { char name_copy[Z_DEVICE_MAX_NAME_LEN]; if (k_usermode_string_copy(name_copy, (char *)name, sizeof(name_copy)) != 0) { return NULL; } return z_impl_device_get_binding(name_copy); } #include <syscalls/device_get_binding_mrsh.c> static inline bool z_vrfy_device_is_ready(const struct device *dev) { K_OOPS(K_SYSCALL_OBJ_INIT(dev, K_OBJ_ANY)); return z_impl_device_is_ready(dev); } #include <syscalls/device_is_ready_mrsh.c> #endif /* CONFIG_USERSPACE */ size_t z_device_get_all_static(struct device const **devices) { size_t cnt; STRUCT_SECTION_GET(device, 0, devices); STRUCT_SECTION_COUNT(device, &cnt); return cnt; } bool z_device_is_ready(const struct device *dev) { /* * if an invalid device pointer is passed as argument, this call * reports the `device` as not ready for usage. */ if (dev == NULL) { return false; } return dev->state->initialized && (dev->state->init_res == 0U); } #ifdef CONFIG_DEVICE_DEPS static int device_visitor(const device_handle_t *handles, size_t handle_count, device_visitor_callback_t visitor_cb, void *context) { /* Iterate over fixed devices */ for (size_t i = 0; i < handle_count; ++i) { device_handle_t dh = handles[i]; const struct device *rdev = device_from_handle(dh); int rc = visitor_cb(rdev, context); if (rc < 0) { return rc; } } return handle_count; } int device_required_foreach(const struct device *dev, device_visitor_callback_t visitor_cb, void *context) { size_t handle_count = 0; const device_handle_t *handles = device_required_handles_get(dev, &handle_count); return device_visitor(handles, handle_count, visitor_cb, context); } int device_supported_foreach(const struct device *dev, device_visitor_callback_t visitor_cb, void *context) { size_t handle_count = 0; const device_handle_t *handles = device_supported_handles_get(dev, &handle_count); return device_visitor(handles, handle_count, visitor_cb, context); } #endif /* CONFIG_DEVICE_DEPS */ |