2019-11-01 04:08:47 -04:00
|
|
|
/*
|
|
|
|
* Copyright (c) 2016 Intel Corporation
|
|
|
|
* Copyright (c) 2016 Wind River Systems, Inc.
|
|
|
|
* Additional Copyright (c) 2018 Espressif Systems (Shanghai) PTE LTD
|
|
|
|
*
|
|
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <errno.h>
|
|
|
|
|
|
|
|
#include "osi/hash_map.h"
|
|
|
|
#include "osi/alarm.h"
|
|
|
|
#include "osi/hash_functions.h"
|
|
|
|
|
|
|
|
#include "mesh_common.h"
|
|
|
|
#include "provisioner_prov.h"
|
|
|
|
|
|
|
|
static hash_map_t *bm_alarm_hash_map;
|
|
|
|
static const size_t BLE_MESH_GENERAL_ALARM_HASH_MAP_SIZE = 20 + CONFIG_BLE_MESH_PBA_SAME_TIME + \
|
|
|
|
CONFIG_BLE_MESH_PBG_SAME_TIME;
|
|
|
|
|
|
|
|
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;
|
|
|
|
|
2020-12-07 04:03:11 -05:00
|
|
|
int64_t k_uptime_get(void)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
2020-12-07 04:03:11 -05:00
|
|
|
/* k_uptime_get_32 is in in milliseconds,
|
2019-11-01 04:08:47 -04:00
|
|
|
* but esp_timer_get_time is in microseconds
|
|
|
|
*/
|
|
|
|
return (esp_timer_get_time() / 1000);
|
|
|
|
}
|
|
|
|
|
2020-12-07 04:03:11 -05:00
|
|
|
uint32_t k_uptime_get_32(void)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
2020-12-07 04:03:11 -05:00
|
|
|
/* k_uptime_get_32 is in in milliseconds,
|
2019-11-01 04:08:47 -04:00
|
|
|
* but esp_timer_get_time is in microseconds
|
|
|
|
*/
|
2020-12-07 04:03:11 -05:00
|
|
|
return (uint32_t)(esp_timer_get_time() / 1000);
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|
|
|
|
|
2020-03-30 06:24:59 -04:00
|
|
|
void bt_mesh_timer_init(void)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
|
|
|
bm_alarm_hash_map = hash_map_new(BLE_MESH_GENERAL_ALARM_HASH_MAP_SIZE,
|
|
|
|
hash_function_pointer, NULL,
|
|
|
|
(data_free_fn)osi_alarm_free, NULL);
|
2020-07-04 06:35:08 -04:00
|
|
|
__ASSERT(bm_alarm_hash_map, "Failed to create hash map");
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|
|
|
|
|
2020-10-15 22:19:31 -04:00
|
|
|
#if CONFIG_BLE_MESH_DEINIT
|
2020-03-30 06:24:59 -04:00
|
|
|
void bt_mesh_timer_deinit(void)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
|
|
|
if (bm_alarm_hash_map) {
|
|
|
|
hash_map_free(bm_alarm_hash_map);
|
|
|
|
bm_alarm_hash_map = NULL;
|
|
|
|
}
|
|
|
|
}
|
2020-10-15 22:19:31 -04:00
|
|
|
#endif /* CONFIG_BLE_MESH_DEINIT */
|
2019-11-01 04:08:47 -04:00
|
|
|
|
2020-05-27 00:26:25 -04:00
|
|
|
int k_delayed_work_init(struct k_delayed_work *work, k_work_handler_t handler)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
|
|
|
osi_alarm_t *alarm = NULL;
|
|
|
|
|
|
|
|
if (!work || !bm_alarm_hash_map) {
|
|
|
|
BT_ERR("%s, Invalid parameter", __func__);
|
2020-05-27 00:26:25 -04:00
|
|
|
return -EINVAL;
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
k_work_init(&work->work, handler);
|
|
|
|
|
|
|
|
bt_mesh_alarm_lock();
|
|
|
|
if (!hash_map_has_key(bm_alarm_hash_map, (void *)work)) {
|
|
|
|
alarm = osi_alarm_new("bt_mesh", (osi_alarm_callback_t)handler, (void *)&work->work, 0);
|
|
|
|
if (alarm == NULL) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_ERR("Alarm not created");
|
2019-11-01 04:08:47 -04:00
|
|
|
bt_mesh_alarm_unlock();
|
2020-05-27 00:26:25 -04:00
|
|
|
return -EIO;
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|
|
|
|
if (!hash_map_set(bm_alarm_hash_map, work, (void *)alarm)) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_ERR("Alarm not set");
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2020-05-27 00:26:25 -04:00
|
|
|
return -EIO;
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
alarm = hash_map_get(bm_alarm_hash_map, work);
|
|
|
|
if (alarm == NULL) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_ERR("Init, alarm not found");
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2020-05-27 00:26:25 -04:00
|
|
|
return -ENODEV;
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
// Just init the work timer only, don't start it.
|
|
|
|
osi_alarm_cancel(alarm);
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2020-05-27 00:26:25 -04:00
|
|
|
return 0;
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|
|
|
|
|
2020-12-07 04:03:11 -05:00
|
|
|
int k_delayed_work_submit(struct k_delayed_work *work, int32_t delay)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
|
|
|
if (!work || !bm_alarm_hash_map) {
|
|
|
|
BT_ERR("%s, Invalid parameter", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_lock();
|
2019-11-01 04:08:47 -04:00
|
|
|
osi_alarm_t *alarm = hash_map_get(bm_alarm_hash_map, (void *)work);
|
|
|
|
if (alarm == NULL) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_WARN("Submit, alarm not found");
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Cancel the alarm first, before start the alarm.
|
|
|
|
osi_alarm_cancel(alarm);
|
|
|
|
osi_alarm_set(alarm, delay);
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-12-07 04:03:11 -05:00
|
|
|
int k_delayed_work_submit_periodic(struct k_delayed_work *work, int32_t period)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
|
|
|
if (!work || !bm_alarm_hash_map) {
|
|
|
|
BT_ERR("%s, Invalid parameter", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_lock();
|
2019-11-01 04:08:47 -04:00
|
|
|
osi_alarm_t *alarm = hash_map_get(bm_alarm_hash_map, (void *)work);
|
|
|
|
if (alarm == NULL) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_WARN("Submit, alarm not found");
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Cancel the alarm first before starting it. */
|
|
|
|
osi_alarm_cancel(alarm);
|
|
|
|
osi_alarm_set_periodic(alarm, period);
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int k_delayed_work_cancel(struct k_delayed_work *work)
|
|
|
|
{
|
|
|
|
if (!work || !bm_alarm_hash_map) {
|
|
|
|
BT_ERR("%s, Invalid parameter", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_lock();
|
2019-11-01 04:08:47 -04:00
|
|
|
osi_alarm_t *alarm = hash_map_get(bm_alarm_hash_map, (void *)work);
|
|
|
|
if (alarm == NULL) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_WARN("Cancel, alarm not found");
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
osi_alarm_cancel(alarm);
|
|
|
|
alarm->deadline_us = 0;
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int k_delayed_work_free(struct k_delayed_work *work)
|
|
|
|
{
|
|
|
|
if (!work || !bm_alarm_hash_map) {
|
|
|
|
BT_ERR("%s, Invalid parameter", __func__);
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_lock();
|
2019-11-01 04:08:47 -04:00
|
|
|
osi_alarm_t *alarm = hash_map_get(bm_alarm_hash_map, work);
|
|
|
|
if (alarm == NULL) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_WARN("Free, alarm not found");
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
osi_alarm_cancel(alarm);
|
|
|
|
hash_map_erase(bm_alarm_hash_map, work);
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-12-07 04:03:11 -05:00
|
|
|
int32_t k_delayed_work_remaining_get(struct k_delayed_work *work)
|
2019-11-01 04:08:47 -04:00
|
|
|
{
|
2020-12-07 04:03:11 -05:00
|
|
|
int32_t time = 0;
|
2020-03-03 06:08:32 -05:00
|
|
|
|
2019-11-01 04:08:47 -04:00
|
|
|
if (!work || !bm_alarm_hash_map) {
|
|
|
|
BT_ERR("%s, Invalid parameter", __func__);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_lock();
|
2019-11-01 04:08:47 -04:00
|
|
|
osi_alarm_t *alarm = hash_map_get(bm_alarm_hash_map, (void *)work);
|
|
|
|
if (alarm == NULL) {
|
2020-07-04 06:35:08 -04:00
|
|
|
BT_WARN("Get time, alarm not found");
|
2020-03-03 06:08:32 -05:00
|
|
|
bt_mesh_alarm_unlock();
|
2019-11-01 04:08:47 -04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-03-03 06:08:32 -05:00
|
|
|
time = osi_alarm_get_remaining_ms(alarm);
|
|
|
|
bt_mesh_alarm_unlock();
|
|
|
|
return time;
|
2019-11-01 04:08:47 -04:00
|
|
|
}
|