zephyr/kernel/nanokernel/device.c

76 lines
2.1 KiB
C

#include <string.h>
#include <device.h>
#include <misc/util.h>
extern struct device __initconfig_start[];
extern struct device __initconfig0_start[];
extern struct device __initconfig1_start[];
extern struct device __initconfig2_start[];
extern struct device __initconfig3_start[];
extern struct device __initconfig4_start[];
extern struct device __initconfig5_start[];
extern struct device __initconfig6_start[];
extern struct device __initconfig7_start[];
extern struct device __initconfig_end[];
static struct device *config_levels[] = {
__initconfig0_start,
__initconfig1_start,
__initconfig2_start,
__initconfig3_start,
__initconfig4_start,
__initconfig5_start,
__initconfig6_start,
__initconfig7_start,
__initconfig_end,
};
/**
* @brief Execute all the driver init functions at a given level
*
* @details Driver init objects are created with the
* __define_initconfig() macro and are placed in RAM by the linker
* script. The {nano|micro}kernel code will execute the init level at
* the appropriate time.
*
* @param level init level to run.
*/
void _sys_device_do_config_level(int level)
{
struct device *info;
for (info = config_levels[level]; info < config_levels[level+1]; info++) {
struct device_config *device = info->config;
device->init(info);
}
}
/**
* @brief Retrieve the device structure for a driver by name
*
* @details Driver config object are created via the
* DECLARE_DEVICE_INIT_CONFIG() macro and placed in ROM by the
* linker. If a driver needs to bind to another driver it will use
* this function to retrieve the device structure of the lower level
* driver by the name the driver exposes to the system.
*
* @param name driver name to search for.
*/
struct device* device_get_binding(char *name)
{
struct device *info;
struct device *found = 0;
int level;
for (level = 0; level < ARRAY_SIZE(config_levels) - 1; level++) {
for (info = config_levels[level];
info < config_levels[level+1]; info++) {
struct device_config *device = info->config;
if (!strcmp(name, device->name)) {
return info;
}
}
}
return found;
}