/*
 * 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);