mirror of
				https://github.com/espressif/esp-idf.git
				synced 2025-10-31 04:59:55 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			332 lines
		
	
	
		
			8.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			332 lines
		
	
	
		
			8.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /******************************************************************************
 | |
|  *
 | |
|  *  Copyright (C) 2014 Google, Inc.
 | |
|  *
 | |
|  *  Licensed under the Apache License, Version 2.0 (the "License");
 | |
|  *  you may not use this file except in compliance with the License.
 | |
|  *  You may obtain a copy of the License at:
 | |
|  *
 | |
|  *  http://www.apache.org/licenses/LICENSE-2.0
 | |
|  *
 | |
|  *  Unless required by applicable law or agreed to in writing, software
 | |
|  *  distributed under the License is distributed on an "AS IS" BASIS,
 | |
|  *  WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 | |
|  *  See the License for the specific language governing permissions and
 | |
|  *  limitations under the License.
 | |
|  *
 | |
|  ******************************************************************************/
 | |
| #include <stdlib.h>
 | |
| #include <string.h>
 | |
| #include <stdbool.h>
 | |
| #include "osi/alarm.h"
 | |
| #include "osi/allocator.h"
 | |
| #include "osi/list.h"
 | |
| #include "esp_timer.h"
 | |
| #include "btc/btc_task.h"
 | |
| #include "btc/btc_alarm.h"
 | |
| #include "osi/mutex.h"
 | |
| #include "bt_common.h"
 | |
| 
 | |
| typedef struct alarm_t {
 | |
|     /* timer id point to here */
 | |
|     esp_timer_handle_t alarm_hdl;
 | |
|     osi_alarm_callback_t cb;
 | |
|     void *cb_data;
 | |
|     int64_t deadline_us;
 | |
| } osi_alarm_t;
 | |
| 
 | |
| enum {
 | |
|     ALARM_STATE_IDLE,
 | |
|     ALARM_STATE_OPEN,
 | |
| };
 | |
| 
 | |
| static osi_mutex_t alarm_mutex;
 | |
| static int alarm_state;
 | |
| 
 | |
| #if (BT_BLE_DYNAMIC_ENV_MEMORY == FALSE)
 | |
| static struct alarm_t alarm_cbs[ALARM_CBS_NUM];
 | |
| #else
 | |
| static struct alarm_t *alarm_cbs;
 | |
| #endif
 | |
| 
 | |
| static osi_alarm_err_t alarm_free(osi_alarm_t *alarm);
 | |
| static osi_alarm_err_t alarm_set(osi_alarm_t *alarm, period_ms_t timeout, bool is_periodic);
 | |
| 
 | |
| int osi_alarm_create_mux(void)
 | |
| {
 | |
|     if (alarm_state != ALARM_STATE_IDLE) {
 | |
|         OSI_TRACE_WARNING("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         return -1;
 | |
|     }
 | |
|     osi_mutex_new(&alarm_mutex);
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| int osi_alarm_delete_mux(void)
 | |
| {
 | |
|     if (alarm_state != ALARM_STATE_IDLE) {
 | |
|         OSI_TRACE_WARNING("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         return -1;
 | |
|     }
 | |
|     osi_mutex_free(&alarm_mutex);
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| void osi_alarm_init(void)
 | |
| {
 | |
|     assert(alarm_mutex != NULL);
 | |
| 
 | |
|     osi_mutex_lock(&alarm_mutex, OSI_MUTEX_MAX_TIMEOUT);
 | |
|     if (alarm_state != ALARM_STATE_IDLE) {
 | |
|         OSI_TRACE_WARNING("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         goto end;
 | |
|     }
 | |
| #if (BT_BLE_DYNAMIC_ENV_MEMORY == TRUE)
 | |
|     if ((alarm_cbs = (osi_alarm_t *)osi_malloc(sizeof(osi_alarm_t) * ALARM_CBS_NUM)) == NULL) {
 | |
|         OSI_TRACE_ERROR("%s, malloc failed\n", __func__);
 | |
|         goto end;
 | |
|     }
 | |
| #endif
 | |
| 
 | |
|     memset(alarm_cbs, 0x00, sizeof(osi_alarm_t) * ALARM_CBS_NUM);
 | |
|     alarm_state = ALARM_STATE_OPEN;
 | |
| 
 | |
| end:
 | |
|     osi_mutex_unlock(&alarm_mutex);
 | |
| }
 | |
| 
 | |
| void osi_alarm_deinit(void)
 | |
| {
 | |
|     assert(alarm_mutex != NULL);
 | |
| 
 | |
|     osi_mutex_lock(&alarm_mutex, OSI_MUTEX_MAX_TIMEOUT);
 | |
|     if (alarm_state != ALARM_STATE_OPEN) {
 | |
|         OSI_TRACE_WARNING("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
|     for (int i = 0; i < ALARM_CBS_NUM; i++) {
 | |
|         if (alarm_cbs[i].alarm_hdl != NULL) {
 | |
|             alarm_free(&alarm_cbs[i]);
 | |
|         }
 | |
|     }
 | |
| 
 | |
| #if (BT_BLE_DYNAMIC_ENV_MEMORY == TRUE)
 | |
|     osi_free(alarm_cbs);
 | |
|     alarm_cbs = NULL;
 | |
| #endif
 | |
| 
 | |
|     alarm_state = ALARM_STATE_IDLE;
 | |
| 
 | |
| end:
 | |
|     osi_mutex_unlock(&alarm_mutex);
 | |
| }
 | |
| 
 | |
| static struct alarm_t *alarm_cbs_lookfor_available(void)
 | |
| {
 | |
|     int i;
 | |
| 
 | |
|     for (i = 0; i < ALARM_CBS_NUM; i++) {
 | |
|         if (alarm_cbs[i].alarm_hdl == NULL) { //available
 | |
|             OSI_TRACE_DEBUG("%s %d %p\n", __func__, i, &alarm_cbs[i]);
 | |
|             return &alarm_cbs[i];
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     return NULL;
 | |
| }
 | |
| 
 | |
| static void alarm_cb_handler(struct alarm_t *alarm)
 | |
| {
 | |
|     OSI_TRACE_DEBUG("TimerID %p\n", alarm);
 | |
|     if (alarm_state != ALARM_STATE_OPEN) {
 | |
|         OSI_TRACE_WARNING("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         return;
 | |
|     }
 | |
|     btc_msg_t msg;
 | |
|     btc_alarm_args_t arg;
 | |
|     msg.sig = BTC_SIG_API_CALL;
 | |
|     msg.pid = BTC_PID_ALARM;
 | |
|     arg.cb = alarm->cb;
 | |
|     arg.cb_data = alarm->cb_data;
 | |
|     btc_transfer_context(&msg, &arg, sizeof(btc_alarm_args_t), NULL);
 | |
| }
 | |
| 
 | |
| osi_alarm_t *osi_alarm_new(const char *alarm_name, osi_alarm_callback_t callback, void *data, period_ms_t timer_expire)
 | |
| {
 | |
|     assert(alarm_mutex != NULL);
 | |
| 
 | |
|     struct alarm_t *timer_id = NULL;
 | |
| 
 | |
|     osi_mutex_lock(&alarm_mutex, OSI_MUTEX_MAX_TIMEOUT);
 | |
|     if (alarm_state != ALARM_STATE_OPEN) {
 | |
|         OSI_TRACE_ERROR("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         timer_id = NULL;
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
|     timer_id = alarm_cbs_lookfor_available();
 | |
| 
 | |
|     if (!timer_id) {
 | |
|         OSI_TRACE_ERROR("%s alarm_cbs exhausted\n", __func__);
 | |
|         timer_id = NULL;
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
|     esp_timer_create_args_t tca;
 | |
|     tca.callback = (esp_timer_cb_t)alarm_cb_handler;
 | |
|     tca.arg = timer_id;
 | |
|     tca.dispatch_method = ESP_TIMER_TASK;
 | |
|     tca.name = alarm_name;
 | |
| 
 | |
|     timer_id->cb = callback;
 | |
|     timer_id->cb_data = data;
 | |
|     timer_id->deadline_us = 0;
 | |
| 
 | |
|     esp_err_t stat = esp_timer_create(&tca, &timer_id->alarm_hdl);
 | |
|     if (stat != ESP_OK) {
 | |
|         OSI_TRACE_ERROR("%s failed to create timer, err 0x%x\n", __func__, stat);
 | |
|         timer_id = NULL;
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
| end:
 | |
|     osi_mutex_unlock(&alarm_mutex);
 | |
|     return timer_id;
 | |
| }
 | |
| 
 | |
| static osi_alarm_err_t alarm_free(osi_alarm_t *alarm)
 | |
| {
 | |
|     if (!alarm || alarm->alarm_hdl == NULL) {
 | |
|         OSI_TRACE_ERROR("%s null\n", __func__);
 | |
|         return OSI_ALARM_ERR_INVALID_ARG;
 | |
|     }
 | |
|     esp_timer_stop(alarm->alarm_hdl);
 | |
|     esp_err_t stat = esp_timer_delete(alarm->alarm_hdl);
 | |
|     if (stat != ESP_OK) {
 | |
|         OSI_TRACE_ERROR("%s failed to delete timer, err 0x%x\n", __func__, stat);
 | |
|         return OSI_ALARM_ERR_FAIL;
 | |
|     }
 | |
| 
 | |
|     memset(alarm, 0, sizeof(osi_alarm_t));
 | |
|     return OSI_ALARM_ERR_PASS;
 | |
| }
 | |
| 
 | |
| void osi_alarm_free(osi_alarm_t *alarm)
 | |
| {
 | |
|     assert(alarm_mutex != NULL);
 | |
| 
 | |
|     osi_mutex_lock(&alarm_mutex, OSI_MUTEX_MAX_TIMEOUT);
 | |
|     if (alarm_state != ALARM_STATE_OPEN) {
 | |
|         OSI_TRACE_ERROR("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         goto end;
 | |
|     }
 | |
|     alarm_free(alarm);
 | |
| 
 | |
| end:
 | |
|     osi_mutex_unlock(&alarm_mutex);
 | |
|     return;
 | |
| }
 | |
| 
 | |
| static osi_alarm_err_t alarm_set(osi_alarm_t *alarm, period_ms_t timeout, bool is_periodic)
 | |
| {
 | |
|     assert(alarm_mutex != NULL);
 | |
| 
 | |
|     osi_alarm_err_t ret = OSI_ALARM_ERR_PASS;
 | |
|     osi_mutex_lock(&alarm_mutex, OSI_MUTEX_MAX_TIMEOUT);
 | |
|     if (alarm_state != ALARM_STATE_OPEN) {
 | |
|         OSI_TRACE_ERROR("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         ret = OSI_ALARM_ERR_INVALID_STATE;
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
|     if (!alarm || alarm->alarm_hdl == NULL) {
 | |
|         OSI_TRACE_ERROR("%s null\n", __func__);
 | |
|         ret = OSI_ALARM_ERR_INVALID_ARG;
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
|     int64_t timeout_us = 1000 * (int64_t)timeout;
 | |
|     esp_err_t stat;
 | |
|     if (is_periodic) {
 | |
|         stat = esp_timer_start_periodic(alarm->alarm_hdl, (uint64_t)timeout_us);
 | |
|     } else {
 | |
|         stat = esp_timer_start_once(alarm->alarm_hdl, (uint64_t)timeout_us);
 | |
|     }
 | |
|     if (stat != ESP_OK) {
 | |
|         OSI_TRACE_ERROR("%s failed to start timer, err 0x%x\n", __func__, stat);
 | |
|         ret = OSI_ALARM_ERR_FAIL;
 | |
|         goto end;
 | |
|     }
 | |
|     alarm->deadline_us = is_periodic ? 0 : (timeout_us + esp_timer_get_time());
 | |
| 
 | |
| end:
 | |
|     osi_mutex_unlock(&alarm_mutex);
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| osi_alarm_err_t osi_alarm_set(osi_alarm_t *alarm, period_ms_t timeout)
 | |
| {
 | |
|     return alarm_set(alarm, timeout, FALSE);
 | |
| }
 | |
| 
 | |
| osi_alarm_err_t osi_alarm_set_periodic(osi_alarm_t *alarm, period_ms_t period)
 | |
| {
 | |
|     return alarm_set(alarm, period, TRUE);
 | |
| }
 | |
| 
 | |
| osi_alarm_err_t osi_alarm_cancel(osi_alarm_t *alarm)
 | |
| {
 | |
|     int ret = OSI_ALARM_ERR_PASS;
 | |
|     osi_mutex_lock(&alarm_mutex, OSI_MUTEX_MAX_TIMEOUT);
 | |
|     if (alarm_state != ALARM_STATE_OPEN) {
 | |
|         OSI_TRACE_ERROR("%s, invalid state %d\n", __func__, alarm_state);
 | |
|         ret = OSI_ALARM_ERR_INVALID_STATE;
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
|     if (!alarm || alarm->alarm_hdl == NULL) {
 | |
|         OSI_TRACE_ERROR("%s null\n", __func__);
 | |
|         ret = OSI_ALARM_ERR_INVALID_ARG;
 | |
|         goto end;
 | |
|     }
 | |
| 
 | |
|     esp_err_t stat = esp_timer_stop(alarm->alarm_hdl);
 | |
|     if (stat != ESP_OK) {
 | |
|         OSI_TRACE_DEBUG("%s failed to stop timer, err 0x%x\n", __func__, stat);
 | |
|         ret = OSI_ALARM_ERR_FAIL;
 | |
|         goto end;
 | |
|     }
 | |
| end:
 | |
|     osi_mutex_unlock(&alarm_mutex);
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| period_ms_t osi_alarm_get_remaining_ms(const osi_alarm_t *alarm)
 | |
| {
 | |
|     assert(alarm_mutex != NULL);
 | |
|     int64_t dt_us = 0;
 | |
| 
 | |
|     osi_mutex_lock(&alarm_mutex, OSI_MUTEX_MAX_TIMEOUT);
 | |
|     dt_us = alarm->deadline_us - esp_timer_get_time();
 | |
|     osi_mutex_unlock(&alarm_mutex);
 | |
| 
 | |
|     return (dt_us > 0) ? (period_ms_t)(dt_us / 1000) : 0;
 | |
| }
 | |
| 
 | |
| uint32_t osi_time_get_os_boottime_ms(void)
 | |
| {
 | |
|     return (uint32_t)(esp_timer_get_time() / 1000);
 | |
| }
 | |
| 
 | |
| bool osi_alarm_is_active(osi_alarm_t *alarm)
 | |
| {
 | |
|     assert(alarm != NULL);
 | |
| 
 | |
|     if (alarm->alarm_hdl != NULL) {
 | |
|         return esp_timer_is_active(alarm->alarm_hdl);
 | |
|     }
 | |
| 
 | |
|     return false;
 | |
| }
 | 
