/*
 * Copyright (c) 2023 HPMicro
 *
 * SPDX-License-Identifier: BSD-3-Clause
 *
 */
#include "start_task.h"
#include "hpm_common.h"
#include "led_task.h"
#include "stdint.h"
#include "task.h"

OS_TCB StartTaskTCB;
OS_Q isr_que;
OS_MEM my_mem;
CPU_STK START_TASK_STK[START_STK_SIZE];
CPU_INT08U ATTR_ALIGN(4) Internal_RamMemp[MY_MEM_NUM][MY_MEMBLOCK_SIZE];

OS_SEM SYNC_SEM;
void start_task(void *p_arg)
{
    OS_ERR err;
    CPU_SR_ALLOC();
    p_arg = p_arg;

    CPU_Init();

#if OS_CFG_STAT_TASK_EN > 0u
    OSStatTaskCPUUsageInit(&err);
#endif

#ifdef CPU_CFG_INT_DIS_MEAS_EN
    CPU_IntDisMeasMaxCurReset();
#endif

#if OS_CFG_SCHED_ROUND_ROBIN_EN
    OSSchedRoundRobinCfg(DEF_ENABLED, 1, &err);
#endif

    CPU_CRITICAL_ENTER();
    OSSemCreate((OS_SEM *)&SYNC_SEM,
        (CPU_CHAR *)"SYNC_SEM",
        (OS_SEM_CTR)0,
        (OS_ERR *)&err);
    OSQCreate((OS_Q *)&isr_que,
        (CPU_CHAR *)"isr_que",
        (OS_MSG_QTY)5,
        (OS_ERR *)&err);
    OSMemCreate((OS_MEM *)&my_mem,
        (CPU_CHAR *)"MY Mem",
        (void *)&Internal_RamMemp[0][0],
        (OS_MEM_QTY)MY_MEM_NUM,
        (OS_MEM_SIZE)MY_MEMBLOCK_SIZE,
        (OS_ERR *)&err);

    OSTaskCreate((OS_TCB *)&Led0TaskTCB,
        (CPU_CHAR *)"led0 task",
        (OS_TASK_PTR)led0_task,
        (void *)0,
        (OS_PRIO)LED0_TASK_PRIO,
        (CPU_STK *)&LED0_TASK_STK[0],
        (CPU_STK_SIZE)LED0_STK_SIZE / 10,
        (CPU_STK_SIZE)LED0_STK_SIZE,
        (OS_MSG_QTY)0,
        (OS_TICK)0,
        (void *)0,
        (OS_OPT)OS_OPT_TASK_STK_CHK | OS_OPT_TASK_STK_CLR,
        (OS_ERR *)&err);

    OSTaskCreate((OS_TCB *)&FloatTaskTCB,
        (CPU_CHAR *)"float test task",
        (OS_TASK_PTR)float_task,
        (void *)0,
        (OS_PRIO)FLOAT_TASK_PRIO,
        (CPU_STK *)&FLOAT_TASK_STK[0],
        (CPU_STK_SIZE)FLOAT_STK_SIZE / 10,
        (CPU_STK_SIZE)FLOAT_STK_SIZE,
        (OS_MSG_QTY)0,
        (OS_TICK)0,
        (void *)0,
        (OS_OPT)OS_OPT_TASK_STK_CHK | OS_OPT_TASK_STK_CLR,
        (OS_ERR *)&err);

    OSTaskSuspend((OS_TCB *)&StartTaskTCB, &err);
    CPU_CRITICAL_EXIT();
}