1 /*
2 * SPDX-FileCopyrightText: 2015-2024 Espressif Systems (Shanghai) CO LTD
3 *
4 * SPDX-License-Identifier: Apache-2.0
5 */
6
7 #include "esp_private/wifi.h"
8 #include "soc/soc_caps.h"
9 #include "esp_attr.h"
10 #include "esp32c3/rom/ets_sys.h"
11 #include "esp_heap_adapter.h"
12 #include "esp_timer.h"
13 #include "soc/rtc.h"
14 #include "esp_private/esp_clk.h"
15 #include "private/esp_coexist_adapter.h"
16 #include "soc/system_reg.h"
17
18 #include <zephyr/logging/log.h>
19 LOG_MODULE_REGISTER(esp32_coex_adapter, CONFIG_WIFI_LOG_LEVEL);
20
21 #define OSI_FUNCS_TIME_BLOCKING 0xffffffff
22
esp_wifi_free(void * mem)23 void esp_wifi_free(void *mem)
24 {
25 esp_wifi_free_func(mem);
26 }
27
esp_coex_common_env_is_chip_wrapper(void)28 bool IRAM_ATTR esp_coex_common_env_is_chip_wrapper(void)
29 {
30 #ifdef CONFIG_IDF_ENV_FPGA
31 return false;
32 #else
33 return true;
34 #endif
35 }
36
esp_coex_common_spin_lock_create_wrapper(void)37 void *esp_coex_common_spin_lock_create_wrapper(void)
38 {
39 unsigned int *wifi_spin_lock = (unsigned int *)wifi_malloc(sizeof(unsigned int));
40 if (wifi_spin_lock == NULL) {
41 LOG_ERR("spin_lock_create_wrapper allocation failed");
42 }
43
44 return (void *)wifi_spin_lock;
45 }
46
esp_coex_common_int_disable_wrapper(void * wifi_int_mux)47 uint32_t IRAM_ATTR esp_coex_common_int_disable_wrapper(void *wifi_int_mux)
48 {
49 unsigned int *int_mux = (unsigned int *)wifi_int_mux;
50
51 *int_mux = irq_lock();
52 return 0;
53 }
54
esp_coex_common_int_restore_wrapper(void * wifi_int_mux,uint32_t tmp)55 void IRAM_ATTR esp_coex_common_int_restore_wrapper(void *wifi_int_mux, uint32_t tmp)
56 {
57 unsigned int *key = (unsigned int *)wifi_int_mux;
58
59 irq_unlock(*key);
60 }
61
esp_coex_common_task_yield_from_isr_wrapper(void)62 void IRAM_ATTR esp_coex_common_task_yield_from_isr_wrapper(void)
63 {
64 k_yield();
65 }
66
esp_coex_common_semphr_create_wrapper(uint32_t max,uint32_t init)67 void *esp_coex_common_semphr_create_wrapper(uint32_t max, uint32_t init)
68 {
69 struct k_sem *sem = (struct k_sem *)wifi_malloc(sizeof(struct k_sem));
70
71 if (sem == NULL) {
72 LOG_ERR("semphr_create_wrapper allocation failed");
73 }
74
75 k_sem_init(sem, init, max);
76
77 return (void *)sem;
78 }
79
esp_coex_common_semphr_delete_wrapper(void * semphr)80 void esp_coex_common_semphr_delete_wrapper(void *semphr)
81 {
82 esp_wifi_free(semphr);
83 }
84
esp_coex_common_semphr_take_wrapper(void * semphr,uint32_t block_time_tick)85 int32_t esp_coex_common_semphr_take_wrapper(void *semphr, uint32_t block_time_tick)
86 {
87 if (block_time_tick == OSI_FUNCS_TIME_BLOCKING) {
88 int ret = k_sem_take((struct k_sem *)semphr, K_FOREVER);
89 if (ret == 0) {
90 return 1;
91 }
92 } else {
93 int ret = k_sem_take((struct k_sem *)semphr, K_TICKS(block_time_tick));
94
95 if (ret == 0) {
96 return 1;
97 }
98 }
99 return 0;
100 }
101
esp_coex_common_semphr_give_wrapper(void * semphr)102 int32_t esp_coex_common_semphr_give_wrapper(void *semphr)
103 {
104 k_sem_give((struct k_sem *)semphr);
105 return 1;
106 }
107
esp_coex_common_timer_disarm_wrapper(void * timer)108 void IRAM_ATTR esp_coex_common_timer_disarm_wrapper(void *timer)
109 {
110 ets_timer_disarm(timer);
111 }
112
esp_coex_common_timer_done_wrapper(void * ptimer)113 void esp_coex_common_timer_done_wrapper(void *ptimer)
114 {
115 ets_timer_done(ptimer);
116 }
117
esp_coex_common_timer_setfn_wrapper(void * ptimer,void * pfunction,void * parg)118 void esp_coex_common_timer_setfn_wrapper(void *ptimer, void *pfunction, void *parg)
119 {
120 ets_timer_setfn(ptimer, pfunction, parg);
121 }
122
esp_coex_common_timer_arm_us_wrapper(void * ptimer,uint32_t us,bool repeat)123 void IRAM_ATTR esp_coex_common_timer_arm_us_wrapper(void *ptimer, uint32_t us, bool repeat)
124 {
125 ets_timer_arm_us(ptimer, us, repeat);
126 }
127
esp_coex_common_malloc_internal_wrapper(size_t size)128 void *IRAM_ATTR esp_coex_common_malloc_internal_wrapper(size_t size)
129 {
130 return wifi_malloc(size);
131 }
132
esp_coex_common_clk_slowclk_cal_get_wrapper(void)133 uint32_t esp_coex_common_clk_slowclk_cal_get_wrapper(void)
134 {
135 /* The bit width of WiFi light sleep clock calibration is 12 while the one of
136 * system is 19. It should shift 19 - 12 = 7.
137 */
138 if (GET_PERI_REG_MASK(SYSTEM_BT_LPCK_DIV_FRAC_REG, SYSTEM_LPCLK_SEL_XTAL)) {
139 uint64_t time_per_us = 1000000ULL;
140 return (((time_per_us << RTC_CLK_CAL_FRACT) / (MHZ(1))) >>
141 (RTC_CLK_CAL_FRACT - SOC_WIFI_LIGHT_SLEEP_CLK_WIDTH));
142 } else {
143 return (esp_clk_slowclk_cal_get() >>
144 (RTC_CLK_CAL_FRACT - SOC_WIFI_LIGHT_SLEEP_CLK_WIDTH));
145 }
146 }
147
148 /* static wrapper */
149
esp_coex_semphr_take_from_isr_wrapper(void * semphr,void * hptw)150 static int32_t IRAM_ATTR esp_coex_semphr_take_from_isr_wrapper(void *semphr, void *hptw)
151 {
152 int *hpt = (int *)hptw;
153
154 int ret = k_sem_take((struct k_sem *)semphr, K_NO_WAIT);
155
156 if (ret == 0) {
157 return 1;
158 }
159
160 *hpt = 0;
161 return 0;
162 }
163
esp_coex_semphr_give_from_isr_wrapper(void * semphr,void * hptw)164 static int32_t IRAM_ATTR esp_coex_semphr_give_from_isr_wrapper(void *semphr, void *hptw)
165 {
166 int *hpt = (int *)hptw;
167
168 k_sem_give((struct k_sem *)semphr);
169
170 *hpt = 0;
171 return 0;
172 }
173
esp_coexist_debug_matrix_init_wrapper(int evt,int sig,bool rev)174 static int esp_coexist_debug_matrix_init_wrapper(int evt, int sig, bool rev)
175 {
176 #if CONFIG_ESP_COEX_GPIO_DEBUG
177 return esp_coexist_debug_matrix_init(evt, sig, rev);
178 #else
179 return ESP_ERR_NOT_SUPPORTED;
180 #endif
181 }
182
coex_is_in_isr_wrapper(void)183 int32_t IRAM_ATTR coex_is_in_isr_wrapper(void)
184 {
185 return k_is_in_isr();
186 }
187
188 coex_adapter_funcs_t g_coex_adapter_funcs = {
189 ._version = COEX_ADAPTER_VERSION,
190 ._task_yield_from_isr = esp_coex_common_task_yield_from_isr_wrapper,
191 ._semphr_create = esp_coex_common_semphr_create_wrapper,
192 ._semphr_delete = esp_coex_common_semphr_delete_wrapper,
193 ._semphr_take_from_isr = esp_coex_semphr_take_from_isr_wrapper,
194 ._semphr_give_from_isr = esp_coex_semphr_give_from_isr_wrapper,
195 ._semphr_take = esp_coex_common_semphr_take_wrapper,
196 ._semphr_give = esp_coex_common_semphr_give_wrapper,
197 ._is_in_isr = coex_is_in_isr_wrapper,
198 ._malloc_internal = esp_coex_common_malloc_internal_wrapper,
199 ._free = esp_wifi_free,
200 ._esp_timer_get_time = esp_timer_get_time,
201 ._timer_disarm = esp_coex_common_timer_disarm_wrapper,
202 ._timer_done = esp_coex_common_timer_done_wrapper,
203 ._timer_setfn = esp_coex_common_timer_setfn_wrapper,
204 ._timer_arm_us = esp_coex_common_timer_arm_us_wrapper,
205 ._debug_matrix_init = esp_coexist_debug_matrix_init_wrapper,
206 ._magic = COEX_ADAPTER_MAGIC,
207 };
208
