83 lines
1.9 KiB
C
83 lines
1.9 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2023 STMicroelectronics
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <zephyr/kernel.h>
|
||
|
|
#include <zephyr/init.h>
|
||
|
|
|
||
|
|
#include "app_conf.h"
|
||
|
|
#include "blestack.h"
|
||
|
|
#include "bpka.h"
|
||
|
|
#include "ll_intf.h"
|
||
|
|
|
||
|
|
K_MUTEX_DEFINE(ble_ctlr_stack_mutex);
|
||
|
|
struct k_work_q ble_ctlr_work_q, ll_work_q;
|
||
|
|
struct k_work ble_ctlr_stack_work, bpka_work;
|
||
|
|
|
||
|
|
uint8_t ll_state_busy;
|
||
|
|
|
||
|
|
#define BLE_CTLR_TASK_STACK_SIZE (256 * 7)
|
||
|
|
#define LL_TASK_STACK_SIZE (256 * 7)
|
||
|
|
#define BLE_CTLR_TASK_PRIO (14)
|
||
|
|
#define LL_TASK_PRIO (14)
|
||
|
|
|
||
|
|
K_THREAD_STACK_DEFINE(ble_ctlr_work_area, BLE_CTLR_TASK_STACK_SIZE);
|
||
|
|
K_THREAD_STACK_DEFINE(ll_work_area, LL_TASK_STACK_SIZE);
|
||
|
|
|
||
|
|
void HostStack_Process(void)
|
||
|
|
{
|
||
|
|
k_work_submit_to_queue(&ble_ctlr_work_q, &ble_ctlr_stack_work);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void ble_ctlr_stack_handler(struct k_work *work)
|
||
|
|
{
|
||
|
|
uint8_t running = 0x0;
|
||
|
|
change_state_options_t options;
|
||
|
|
|
||
|
|
k_mutex_lock(&ble_ctlr_stack_mutex, K_FOREVER);
|
||
|
|
running = BleStack_Process();
|
||
|
|
k_mutex_unlock(&ble_ctlr_stack_mutex);
|
||
|
|
|
||
|
|
if (ll_state_busy == 1) {
|
||
|
|
options.combined_value = 0x0F;
|
||
|
|
ll_intf_chng_evnt_hndlr_state(options);
|
||
|
|
ll_state_busy = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (running == BLE_SLEEPMODE_RUNNING) {
|
||
|
|
HostStack_Process();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void BPKACB_Process(void)
|
||
|
|
{
|
||
|
|
k_work_submit_to_queue(&ble_ctlr_work_q, &bpka_work);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void bpka_work_handler(struct k_work *work)
|
||
|
|
{
|
||
|
|
BPKA_BG_Process();
|
||
|
|
}
|
||
|
|
|
||
|
|
static int stm32wba_ble_ctlr_init(void)
|
||
|
|
{
|
||
|
|
k_work_queue_init(&ble_ctlr_work_q);
|
||
|
|
k_work_queue_start(&ble_ctlr_work_q, ble_ctlr_work_area,
|
||
|
|
K_THREAD_STACK_SIZEOF(ble_ctlr_work_area),
|
||
|
|
BLE_CTLR_TASK_PRIO, NULL);
|
||
|
|
|
||
|
|
k_work_queue_init(&ll_work_q);
|
||
|
|
k_work_queue_start(&ll_work_q, ll_work_area,
|
||
|
|
K_THREAD_STACK_SIZEOF(ll_work_area),
|
||
|
|
LL_TASK_PRIO, NULL);
|
||
|
|
|
||
|
|
k_work_init(&ble_ctlr_stack_work, &ble_ctlr_stack_handler);
|
||
|
|
k_work_init(&bpka_work, &bpka_work_handler);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
SYS_INIT(stm32wba_ble_ctlr_init, POST_KERNEL, CONFIG_KERNEL_INIT_PRIORITY_DEFAULT);
|