1 /*
2 * Copyright 2020 Google LLC
3 * Copyright (c) 2020 Nordic Semiconductor ASA
4 *
5 * SPDX-License-Identifier: Apache-2.0
6 */
7
8 #define LOG_LEVEL CONFIG_EMUL_LOG_LEVEL
9 #include <zephyr/logging/log.h>
10 LOG_MODULE_REGISTER(emul);
11
12 #include <zephyr/device.h>
13 #include <zephyr/drivers/emul.h>
14 #include <zephyr/sys/iterable_sections.h>
15 #include <string.h>
16
emul_get_binding(const char * name)17 const struct emul *emul_get_binding(const char *name)
18 {
19 STRUCT_SECTION_FOREACH(emul, emul_it) {
20 if (strcmp(emul_it->dev->name, name) == 0) {
21 return emul_it;
22 }
23 }
24
25 return NULL;
26 }
27
emul_init_for_bus(const struct device * dev)28 int emul_init_for_bus(const struct device *dev)
29 {
30 const struct emul_list_for_bus *cfg = dev->config;
31
32 /*
33 * Walk the list of children, find the corresponding emulator and
34 * initialise it.
35 */
36 const struct emul_link_for_bus *elp;
37 const struct emul_link_for_bus *const end = cfg->children + cfg->num_children;
38
39 LOG_INF("Registering %d emulator(s) for %s", cfg->num_children, dev->name);
40 for (elp = cfg->children; elp < end; elp++) {
41 const struct emul *emul = emul_get_binding(elp->dev->name);
42
43 if (!emul) {
44 LOG_WRN("Cannot find emulator for '%s'", elp->dev->name);
45 continue;
46 }
47
48 switch (emul->bus_type) {
49 case EMUL_BUS_TYPE_I2C:
50 emul->bus.i2c->target = emul;
51 break;
52 case EMUL_BUS_TYPE_ESPI:
53 emul->bus.espi->target = emul;
54 break;
55 case EMUL_BUS_TYPE_SPI:
56 emul->bus.spi->target = emul;
57 break;
58 }
59 int rc = emul->init(emul, dev);
60
61 if (rc != 0) {
62 LOG_WRN("Init %s emulator failed: %d",
63 elp->dev->name, rc);
64 }
65
66 switch (emul->bus_type) {
67 #ifdef CONFIG_I2C_EMUL
68 case EMUL_BUS_TYPE_I2C:
69 rc = i2c_emul_register(dev, emul->bus.i2c);
70 break;
71 #endif /* CONFIG_I2C_EMUL */
72 #ifdef CONFIG_ESPI_EMUL
73 case EMUL_BUS_TYPE_ESPI:
74 rc = espi_emul_register(dev, emul->bus.espi);
75 break;
76 #endif /* CONFIG_ESPI_EMUL */
77 #ifdef CONFIG_SPI_EMUL
78 case EMUL_BUS_TYPE_SPI:
79 rc = spi_emul_register(dev, emul->bus.spi);
80 break;
81 #endif /* CONFIG_SPI_EMUL */
82 default:
83 rc = -EINVAL;
84 LOG_WRN("Found no emulated bus enabled to register emulator %s",
85 elp->dev->name);
86 }
87
88 if (rc != 0) {
89 LOG_WRN("Failed to register emulator for %s: %d", elp->dev->name, rc);
90 }
91 }
92
93 return 0;
94 }
95
