jinhong/YB_Platform
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
YB_Platform/public/ape_spu/osp/src/osp_task.s.c

914 lines
29 KiB
C
Raw Normal View History

First commit
2023-07-13 11:27:03 +08:00
#include <string.h>
#include "osp_type_def.h"
#include "err_num.h"
#include "osp_msg.h"
#include "osp_sw_queue.h"
#include "osp_task.h"
#include "osp_timer.h"
#include "osp_sem.h"
#include "osp_mem.h"
#include "osp_io.h"
#include "smartos.h"
#include "ucp_printf.h"
#include "ucp_tick.h"
#include "spu_shell.h"
#define DE_ONE_VALUE (1)
//int idle_preem_times = 0;
int g_cur_task_id = 0;
int g_task_id_table[TASK_MAX] = {0};
uint8_t g_taskid_num = 0;
int g_prio_array[TASK_MAX] = {0};
int g_task_id_array[TASK_MAX] = {0};
int *g_tcb_handler_tbl[TASK_MAX] = {NULL};
#ifdef UCP_TICK_ENABLE
extern osp_msg_tick_info st_tick_info;
#endif
#ifdef OSP_TASK_DBG_ENABLE
osp_task_dbg_info_t gst_osp_task_dbg_info[TASK_MAX];
#endif
/* 任务模块初始化函数 */
void osp_task_init(void)
{
memset(g_tcb_handler_tbl, 0 , TASK_MAX*sizeof(int));
memset(g_prio_array, 0, sizeof(g_prio_array));
memset(g_task_id_array, 0, sizeof(g_task_id_array));
#ifdef OSP_TASK_DBG_ENABLE
memset(&gst_osp_task_dbg_info, 0, sizeof(osp_task_dbg_info_t)*TASK_MAX);
#endif
spu_insert_cmd_ext("i_ape", (OSP_FUNCPTR)osp_show_task_info, "osp show task info", 0);
#ifdef OSP_MSG_DBG_ENABLE
spu_insert_cmd_ext("e_ape", (OSP_FUNCPTR)osp_show_msg_info, "osp show msg info", 0);
1. New Feature#910 2. Feature Enhancement#914 3. update from V2.0, by msg_transfer synch 4. add osp_send_msg/osp_var_init by synch
2023-07-22 17:27:21 +08:00
#ifdef UCP_OSP_DBG_HW_CNT_ENABLE
spu_insert_cmd_ext("em_ape", (OSP_FUNCPTR)osp_show_msg_dbg_info_by_coreid_taskid, "osp show msg by id", 2);
#endif /* UCP_OSP_DBG_HW_CNT_ENABLE */
First commit
2023-07-13 11:27:03 +08:00
#endif
return ;
}
/* 任务模块任务处理函数（操作系统回调后，回调各注册任务） */
static void osp_event_task(void *data)
{
osp_tcb *tcb_val = (osp_tcb*)data;
osp_msg_head *ptr = NULL;
(tcb_val->init_func == NULL)? 0:tcb_val->init_func();
while(1)
{
//debug_write(OSP_DEBUG_POT(g_ape_id, 49), tcb_val->task_id);
osp_wait_sem(tcb_val->event_sem);
#ifdef UCP_TICK_ENABLE
rdmcycle(&st_tick_info.u32_sem_wait_tick);
#endif
osp_recv_msg(&ptr);
//UCP_PRINT_ERROR("osp_event_task >>> ptr = 0x%x, data = 0x%x, size = 0x%x\r\n", ptr, ptr->data, ptr->msg_size);
//debug_write(OSP_DEBUG_POT(g_ape_id, 36), (uint32_t)(ptr->data));
//debug_write(OSP_DEBUG_POT(g_ape_id, 37), ptr->msg_size);
//debug_write(OSP_DEBUG_POT(g_ape_id, 38), (uint32_t)(ptr));
#ifdef UCP_TICK_ENABLE
rdmcycle(&st_tick_info.u32_callback_tick);
#endif
#ifdef OSP_TASK_DBG_ENABLE
tcb_val->run_times++;
gst_osp_task_dbg_info[tcb_val->task_id].u32Call_before++;
#endif
tcb_val->loop_fun(ptr->data, ptr->msg_size);
#ifdef OSP_TASK_DBG_ENABLE
gst_osp_task_dbg_info[tcb_val->task_id].u32Call_after++;
//UCP_PRINT_ERROR("event:id=%d,%d,%d", tcb_val->task_id, gst_osp_task_dbg_info[tcb_val->task_id].u32Call_before, gst_osp_task_dbg_info[tcb_val->task_id].u32Call_after);
#endif
}
}
#ifdef UCP_OSP_DBG_ENABLE
uint32_t g_u32_osp_mtimer_cnt = 0;
uint32_t g_u32_osp_mtimer_callback_cnt = 0;
#endif
static void osp_mtimer_task(void *data)
{
osp_tcb *tcb_val = (osp_tcb*)data;
//osp_msg_head *ptr = NULLPTR;
(tcb_val->init_func == NULL)? 0:tcb_val->init_func();
while(1)
{
osp_wait_sem(tcb_val->sem); //本文件不要存在os 接口函数
#ifdef UCP_OSP_DBG_ENABLE
g_u32_osp_mtimer_cnt++;
debug_write(OSP_DEBUG_POT(g_ape_id, 11), g_u32_osp_mtimer_cnt);
#endif
#ifdef OSP_TASK_DBG_ENABLE
tcb_val->run_times++;
gst_osp_task_dbg_info[tcb_val->task_id].u32Call_before++;
#endif
tcb_val->loop_fun(data);
#ifdef OSP_TASK_DBG_ENABLE
gst_osp_task_dbg_info[tcb_val->task_id].u32Call_before++;
#endif
#ifdef UCP_OSP_DBG_ENABLE
g_u32_osp_mtimer_callback_cnt++;
debug_write(OSP_DEBUG_POT(g_ape_id, 12), g_u32_osp_mtimer_callback_cnt);
#endif
}
}
static void osp_loop_task(void *data)
{
osp_tcb *tcb_val = (osp_tcb*)data;
//osp_msg_head *ptr = NULLPTR;
(tcb_val->init_func == NULL)? 0:tcb_val->init_func();
while(1)
{
osp_delay_cycle(tcb_val->delay_cycle);
tcb_val->loop_fun(data);
/*if(tcb_val->once_value != 0)
{
osp_del_task(tcb_val->priority);
}*/
#ifdef OSP_TASK_DBG_ENABLE
tcb_val->run_times++;
#endif
}
}
static void osp_driver_task(void *data)
{
osp_tcb *tcb_val = (osp_tcb*)data;
osp_msg_head *ptr = NULL;
(tcb_val->init_func == NULL)? 0:tcb_val->init_func();
while(1)
{
osp_delay_cycle(tcb_val->delay_cycle);
osp_wait_sem(tcb_val->sem); //本文件不要存在os 接口函数
osp_wait_sem(tcb_val->event_sem);
// 查表
//osp_post_sem(task_id);
if(tcb_val->task_type == OSP_EVENT_TYPE)
{
osp_recv_msg(&ptr);
tcb_val->loop_fun(ptr->data, ptr->msg_size);
}
else
{
tcb_val->loop_fun(data);
}
if(tcb_val->once_value != 0)
{
osp_del_task(tcb_val->priority);
}
}
}
static void osp_osp_task(void *data)
{
osp_tcb *tcb_val = (osp_tcb*)data;
osp_msg_head *ptr = NULL;
(tcb_val->init_func == NULL)? 0:tcb_val->init_func();
while(1)
{
osp_delay_cycle(tcb_val->delay_cycle);
osp_wait_sem(tcb_val->sem); //本文件不要存在os 接口函数
osp_wait_sem(tcb_val->event_sem);
// 查表
//osp_post_sem(task_id);
if(tcb_val->task_type == OSP_EVENT_TYPE)
{
osp_recv_msg(&ptr);
tcb_val->loop_fun(ptr->data, ptr->msg_size);
}
else
{
tcb_val->loop_fun(data);
}
if(tcb_val->once_value != 0)
{
osp_del_task(tcb_val->priority);
}
}
}
#if 0
static void osp_task_entry(void *data)
{
osp_tcb *tcb_val = (osp_tcb*)data;
osp_msg_head *ptr = NULLPTR;
(tcb_val->init_func == NULLPTR)? 0:tcb_val->init_func();
while(1)
{
osp_delay_cycle(tcb_val->delay_cycle);
osp_wait_sem(tcb_val->sem); //本文件不要存在os 接口函数
osp_wait_sem(tcb_val->event_sem);
// 查表
//osp_post_sem(task_id);
if(tcb_val->task_type == OSP_EVENT_TYPE)
{
osp_recv_msg(&ptr);
tcb_val->loop_fun(ptr->data, ptr->msg_size);
}
else
{
tcb_val->loop_fun(data);
}
if(tcb_val->once_value != 0)
{
osp_del_task(tcb_val->priority);
}
}
}
#endif
/*
静态任务注册
*/
int osp_task_reg(osp_task_inf *task_array, osp_task_ext_inf *task_ext_array, int apeid)
{
void (*ptask_fun)(void *);
osp_task_inf *osp_task_ptr = task_array;
osp_tcb *tcb_handle = NULL;
char *stack_down = NULL;
char *stack_top = NULL;
osp_task_ext_inf *local_ext_info_p = task_ext_array;
int ret = 0;
while(osp_task_ptr->end_flag != 0xffff)
//while(osp_task_ptr->apeid_bitmap != 0xffff)
{
#if 0
if(osp_task_ptr->ape_id != apeid)
//if((osp_task_ptr->apeid_bitmap&(1<<apeid)) == 0)
{
osp_task_ptr++;
continue;
}
#endif
/*task parameter validity check*/
if(osp_task_ptr->task_entry == NULL)
{
UCP_PRINT_ERROR("task entry is none\n\r");
return -OSP_PAR_ILL;
}
if(osp_task_ptr->task_id > TASK_MAX)
{
UCP_PRINT_ERROR("task id is error\n\r");
return -OSP_PAR_ILL;
}
if(osp_task_ptr->task_prio > PRIO_MIN)
{
UCP_PRINT_ERROR("task PRIO is error\n\r");
return -OSP_PAR_ILL;
}
if(osp_task_ptr->task_stack_size > M_STACK_SIZE)
{
UCP_PRINT_ERROR("task stack size is to large\n\r");
return -OSP_PAR_ILL;
}
if(g_prio_array[osp_task_ptr->task_prio] != 0)
{
UCP_PRINT_ERROR("task prio is repeat\n\r");
UCP_PRINT_ERROR("task register failed passed\n\r");
osp_task_ptr++;
continue;
}
g_prio_array[osp_task_ptr->task_id] = osp_task_ptr->task_prio;
if(g_task_id_array[osp_task_ptr->task_prio] != 0)
{
UCP_PRINT_ERROR("task id is repeat\n\r");
UCP_PRINT_ERROR("task register failed passed\n\r");
osp_task_ptr++;
continue;
}
g_task_id_array[osp_task_ptr->task_prio] = osp_task_ptr->task_id;
stack_down = (char*)osp_malloc(osp_task_ptr->task_stack_size+12);
if(stack_down == NULL)
{
UCP_PRINT_ERROR("task 0x%08x stack alloc failed\n\r",osp_task_ptr->task_id);
goto malloc_stack_failed;
}
*(int*)stack_down = LOW_VALUE0;
stack_down += 4;
stack_top = stack_down + osp_task_ptr->task_stack_size;
*((int*)(stack_top + 4)) = TOP_VALUE0;
tcb_handle = (osp_tcb*)osp_malloc(sizeof(osp_tcb));
if(tcb_handle == NULL)
{
UCP_PRINT_ERROR("task 0x%08x tcb alloc failed\n\r",osp_task_ptr->task_id);
goto tcb_malloc_failed;
}
memset((void*)tcb_handle, 0, sizeof(osp_tcb));
local_ext_info_p = task_ext_array;
while(local_ext_info_p->end_flag != 0xffff)
//while(local_ext_info_p->apeid_bitmap != 0xffff)
{
if(osp_task_ptr->end_flag == local_ext_info_p->end_flag)
//if((osp_task_ptr->apeid_bitmap&(1<<apeid)) == (local_ext_info_p->apeid_bitmap&(1<<apeid)))
{
if(osp_task_ptr->task_id == local_ext_info_p->task_id)
{
tcb_handle->delay_cycle = local_ext_info_p->delay_value; // 如果为0 不会delay
if((local_ext_info_p->sem_value != 0)
&& ((local_ext_info_p->task_type == OSP_TIMER_TYPE)
||(local_ext_info_p->task_type == OSP_DRIVER_TYPE)
||(local_ext_info_p->task_type == OSP_OSP_TYPE)))
{
tcb_handle->sem = osp_create_sem(0);
}
else if(local_ext_info_p->sem_value != 0&&(local_ext_info_p->task_type == OSP_EVENT_TYPE))
{
tcb_handle->event_sem = osp_create_sem(0);
tcb_handle->que_head = (osp_sw_queue*)osp_malloc(sizeof(osp_sw_queue));
if (NULL == tcb_handle->que_head)
{
UCP_PRINT_ERROR("task 0x%08x sw_que alloc failed\n\r",osp_task_ptr->task_id);
osp_delete_sem(tcb_handle->event_sem);
FREE((stack_down-4));
FREE((char*)tcb_handle);
return -OSP_MEM_FULL;
}
if (OSP_OK != osp_sw_queue_int(tcb_handle->que_head))
{
UCP_PRINT_ERROR("task 0x%08x sw_que alloc failed\n\r", osp_task_ptr->task_id);
osp_delete_sem(tcb_handle->event_sem);
FREE((stack_down-4));
FREE((char*)tcb_handle);
return -1;
}
//memset(tcb_handle->que_head, 0, sizeof(osp_sw_queue));
}
tcb_handle->task_type = local_ext_info_p->task_type;
tcb_handle->once_value = local_ext_info_p->once_value;
break;
}
}
local_ext_info_p++;
}
if(local_ext_info_p->end_flag == 0xffff)
//if(local_ext_info_p->apeid_bitmap == 0xffff)
{
// 系统平台设置默认扩展参数
tcb_handle->delay_cycle = 1;
tcb_handle->sem = NULL;
tcb_handle->event_sem = NULL;
tcb_handle->task_type = OSP_NORMAL_TYPE;
tcb_handle->once_value = 0;
}
g_task_id_table[g_taskid_num] = osp_task_ptr->task_id;
g_taskid_num++;
tcb_handle->task_id = osp_task_ptr->task_id;
tcb_handle->priority = osp_task_ptr->task_prio;
tcb_handle->stack_size = osp_task_ptr->task_stack_size;
tcb_handle->stack_top = (UINTPTR)stack_top;
tcb_handle->stack_down = (UINTPTR)stack_down;
tcb_handle->init_func = osp_task_ptr->task_init;
tcb_handle->loop_fun = osp_task_ptr->task_entry;
//tcb_handle->que = NULLPTR;
tcb_handle->data = osp_task_ptr->task_prio;
STRCPY((char*)tcb_handle->task_name, (const char*)osp_task_ptr->task_name);
//tcb_handle->task_name = osp_task_ptr->task_name;
g_tcb_handler_tbl[tcb_handle->task_id] = (int*)tcb_handle;
switch(local_ext_info_p->task_type)
{
case OSP_NORMAL_TYPE:
{
ptask_fun = osp_loop_task;
break;
}
case OSP_EVENT_TYPE:
{
ptask_fun = osp_event_task;
break;
}
case OSP_TIMER_TYPE:
{
ptask_fun = osp_mtimer_task;
break;
}
case OSP_DRIVER_TYPE:
{
ptask_fun = osp_driver_task;
break;
}
case OSP_OSP_TYPE:
{
ptask_fun = osp_osp_task;
break;
}
}
UCP_PRINT_LOG("task_id = 0x%08x.\r\n", tcb_handle->task_id);
ret = smart_task_create ((void*)ptask_fun,
(void *)tcb_handle,
(uint32_t *)stack_top,
tcb_handle->priority,
tcb_handle->task_id,
(uint32_t *)stack_down,
tcb_handle->stack_size);
if (0 != ret)
{
debug_write(DBG_DDR_ERR_IDX(apeid, 25), ret);
if (OSP_EVENT_TYPE == local_ext_info_p->task_type)
{
FREE((char*)(tcb_handle->que_head));
osp_delete_sem(tcb_handle->event_sem);
}
else
{
osp_delete_sem(tcb_handle->sem);
}
FREE((stack_down-4));
FREE((char*)tcb_handle);
return -1;
}
if (0 != ret)
{
debug_write(DBG_DDR_ERR_IDX(apeid, 25), ret);
}
UCP_PRINT_LOG("task_id = 0x%08x, smart_task_create return :0x%08x.\r\n", tcb_handle->task_id, ret);
#if 0
OSTaskCreateExt ((void *)osp_task_entry, /// osp_event_task/ osp_timer_task/osp_driver_task/osp_ops_task
(void *)tcb_handle,
(OS_STK *)stack_top,
tcb_handle->priority,
tcb_handle->task_id,
(OS_STK *)stack_down,
tcb_handle->stack_size,
(void *)0,
0);
#endif
osp_task_ptr++;
continue;
tcb_malloc_failed:
FREE(stack_down);
malloc_stack_failed:
g_prio_array[osp_task_ptr->task_id] = 0;
g_task_id_array[osp_task_ptr->task_prio] = 0;
osp_task_ptr++;
}
return OSP_OK;
}
/*
动态任务注册
*/
/*
动态任务注册扩展，增加了时间点配置
后续接口可以设置成这样
int osp_task_create(osp_task_attr_ext *t_attr_val，int timer_cyl)
timer_cyl 参数用来指明当前 支持10的slot 周期还是支持5个slot 周期
再次分析了时间点配置10 cyl ,5 cyl, 任务注册使用没有任何区别
区别掉在rfc 中断 时隙号的计算
*/
int osp_task_create(osp_task_info_ex *t_info_val)
{
#ifdef UCP_TICK_ENABLE
uint32_t clockBegin,clockEnd;
int32_t clockCnt;
rdmcycle(&clockBegin);
#endif
static uint8_t su8_index = 0;
osp_tcb *tcb_handle = NULL;
char *stack_down = NULL;
char *stack_top = NULL;
void (*ptask_fun)(void *);
int ret = -1;
if(t_info_val->task_entry == NULL)
{
UCP_PRINT_ERROR("task entry is none\n\r");
debug_write(OSP_DEBUG_POT(g_ape_id, 20), t_info_val->task_id);
return -OSP_PAR_ILL;
}
if(t_info_val->task_id > TASK_MAX)
{
UCP_PRINT_ERROR("task id is error\n\r");
debug_write(OSP_DEBUG_POT(g_ape_id, 21), t_info_val->task_id);
return -OSP_PAR_ILL;
}
if(t_info_val->task_prio > PRIO_MIN)
{
UCP_PRINT_ERROR("task PRIO is error\n\r");
debug_write(OSP_DEBUG_POT(g_ape_id, 22), t_info_val->task_prio);
return -OSP_PAR_ILL;
}
if(t_info_val->stack_size > M_STACK_SIZE)
{
UCP_PRINT_ERROR("task stack size is to large\n\r");
debug_write(OSP_DEBUG_POT(g_ape_id, 23), t_info_val->stack_size);
return -OSP_PAR_ILL;
}
if(g_prio_array[t_info_val->task_id] != 0)
{
UCP_PRINT_ERROR("task prio is repeat\n\r");
UCP_PRINT_ERROR("task register failed passed\n\r");
debug_write(OSP_DEBUG_POT(g_ape_id, 24), t_info_val->task_id);
return -OSP_PAR_REP;
}
g_prio_array[t_info_val->task_id] = t_info_val->task_prio;
if(g_task_id_array[t_info_val->task_prio] != 0)
{
UCP_PRINT_ERROR("task 0x%08x id is repeat\n\r",t_info_val->task_id);
UCP_PRINT_ERROR("task register failed passed\n\r");
debug_write(OSP_DEBUG_POT(g_ape_id, 25), t_info_val->task_id);
return -OSP_PAR_REP;
}
g_task_id_array[t_info_val->task_prio] = t_info_val->task_id;
stack_down = (char*)MALLOC(t_info_val->stack_size + 12);
if(stack_down == NULL)
{
UCP_PRINT_ERROR("task 0x%08x stack alloc failed\n\r",t_info_val->task_id);
debug_write(OSP_DEBUG_POT(g_ape_id, 26), t_info_val->task_id);
goto alloc_stack_failed;
}
*(int*)stack_down = LOW_VALUE0;
stack_down += 4;
stack_top = stack_down + t_info_val->stack_size;
*((int*)(stack_top + 4)) = TOP_VALUE0;
tcb_handle = (osp_tcb*)MALLOC(sizeof(osp_tcb));
if(tcb_handle == NULL)
{
UCP_PRINT_ERROR("task 0x%08x tcb alloc failed\n\r",t_info_val->task_id);
debug_write(OSP_DEBUG_POT(g_ape_id, 27), t_info_val->task_id);
goto tcb_alloc_failed;
}
memset(tcb_handle, 0, sizeof(osp_tcb));
tcb_handle->delay_cycle = t_info_val->delay_value;
//if((t_attr_val->sem_value != 0) && (t_attr_val->task_type == OSP_TIMER_TYPE))
if ((t_info_val->task_type == OSP_TIMER_TYPE) || (t_info_val->task_type == OSP_DRIVER_TYPE) || (t_info_val->task_type == OSP_OSP_TYPE))
{
tcb_handle->sem = osp_create_sem(0);
}
//else if((t_attr_val->sem_value != 0) && (t_attr_val->task_type == OSP_EVENT_TYPE))
if (t_info_val->task_type == OSP_EVENT_TYPE)
{
tcb_handle->event_sem = osp_create_sem(0);
tcb_handle->que_head = (osp_sw_queue*)osp_malloc(sizeof(osp_sw_queue));
if (NULL == tcb_handle->que_head)
{
UCP_PRINT_ERROR("task 0x%08x sw_que alloc failed\n\r", t_info_val->task_id);
debug_write(OSP_DEBUG_POT(g_ape_id, 28), t_info_val->task_id);
osp_delete_sem(tcb_handle->event_sem);
FREE((stack_down-4));
FREE((char*)tcb_handle);
return -1;
}
if (OSP_OK != osp_sw_queue_int(tcb_handle->que_head))
{
UCP_PRINT_ERROR("task 0x%08x sw_que alloc failed\n\r", t_info_val->task_id);
debug_write(OSP_DEBUG_POT(g_ape_id, 19), t_info_val->task_id);
osp_delete_sem(tcb_handle->event_sem);
FREE((stack_down-4));
FREE((char*)tcb_handle);
return -1;
}
//memset(tcb_handle->que_head, 0, sizeof(osp_sw_queue));
}
tcb_handle->task_type = t_info_val->task_type;
tcb_handle->once_value = DE_ONE_VALUE;
tcb_handle->task_id = t_info_val->task_id;
tcb_handle->priority = t_info_val->task_prio;
tcb_handle->stack_size = t_info_val->stack_size;
tcb_handle->stack_top = (UINTPTR)stack_top;
tcb_handle->stack_down = (UINTPTR)stack_down;
tcb_handle->init_func = t_info_val->task_init;
tcb_handle->loop_fun = t_info_val->task_entry;
tcb_handle->data = t_info_val->task_prio;
strncpy(tcb_handle->task_name, (const char*)t_info_val->task_name, (OSP_TASK_NAME_LEN-1));
//STRCPY(tcb_handle->task_name, (const char*)t_info_val->task_name);
g_tcb_handler_tbl[tcb_handle->task_id] = (int*)tcb_handle;
//if((t_info_val->t_off != 0)&&(t_info_val->s_bitmap != 0))
if((OSP_TIMER_TYPE == t_info_val->task_type) && (t_info_val->s_bitmap != 0))
{
if(g_osp_timer_desc_idx >= OSP_TIMER_COUNTS)
{
debug_write(OSP_DEBUG_POT(g_ape_id, 29), t_info_val->task_id);
UCP_PRINT_ERROR("timer point is overflow\n\r");
UCP_PRINT_ERROR("timer cfg failed\n\r");
return -1;
}
g_osp_timer_desc[g_osp_timer_desc_idx].task_id = t_info_val->task_id;
g_osp_timer_desc[g_osp_timer_desc_idx].slot_bitmap = t_info_val->s_bitmap;
g_osp_timer_desc[g_osp_timer_desc_idx].t_offset = t_info_val->t_off;
g_osp_timer_desc_idx++;
}
g_task_id_table[g_taskid_num] = t_info_val->task_id;
g_taskid_num++;
switch(t_info_val->task_type)
{
case OSP_NORMAL_TYPE:
{
ptask_fun = osp_loop_task;
break;
}
case OSP_EVENT_TYPE:
{
ptask_fun = osp_event_task;
break;
}
case OSP_TIMER_TYPE:
{
ptask_fun = osp_mtimer_task;
break;
}
case OSP_DRIVER_TYPE:
{
ptask_fun = osp_driver_task;
break;
}
case OSP_OSP_TYPE:
{
ptask_fun = osp_osp_task;
break;
}
}
ret = smart_task_create ((void*)ptask_fun,
(void *)tcb_handle,
(uint32_t *)stack_top,
tcb_handle->priority,
tcb_handle->task_id,
(uint32_t *)stack_down,
tcb_handle->stack_size);
if (0 != ret)
{
debug_write(DBG_DDR_ERR_IDX(g_ape_id, 26), ret);
if (OSP_EVENT_TYPE == t_info_val->task_type)
{
FREE((char*)(tcb_handle->que_head));
osp_delete_sem(tcb_handle->event_sem);
}
else
{
osp_delete_sem(tcb_handle->sem);
}
FREE((stack_down-4));
FREE((char*)tcb_handle);
return -1;
}
UCP_PRINT_LOG("smart_task_create return: 0x%08x, task_id = 0x%08x, task_pro = 0x%08x\r\n", ret, tcb_handle->task_id, tcb_handle->priority);
debug_write(OSP_DEBUG_POT(g_ape_id, 30), ret);
debug_write(OSP_DEBUG_POT(g_ape_id, 31), t_info_val->task_id);
if (su8_index < 5)
{
debug_write(OSP_DEBUG_POT(g_ape_id, (225+su8_index)), t_info_val->task_id);
debug_write(OSP_DEBUG_POT(g_ape_id, (230+su8_index)), stack_top);
debug_write(OSP_DEBUG_POT(g_ape_id, (235+su8_index)), stack_down);
}
su8_index++;
#ifdef UCP_TICK_ENABLE
rdmcycle(&clockEnd);
clockCnt = clockEnd - clockBegin;
debug_write(OSP_DEBUG_POT(g_ape_id, 200), clockCnt);
#endif
#if 0
OSTaskCreateExt ((void *)osp_task_entry,
(void *)tcb_handle,
(OS_STK *)stack_top,
tcb_handle->priority,
tcb_handle->task_id,
(OS_STK *)stack_down,
tcb_handle->stack_size,
(void *)0,
0);
#endif
return 0;
tcb_alloc_failed:
FREE(stack_down);
alloc_stack_failed:
g_prio_array[t_info_val->task_id] = 0;
g_task_id_array[t_info_val->task_prio] = 0;
return -1;
}
void osp_del_timer_task(int task_id)
{
uint8_t u8_loop = 0;
int task_prio = 0;
osp_tcb *tcb_handle = NULL;
/* 通过任务ID找到任务控制块信息 */
tcb_handle = (osp_tcb*)g_tcb_handler_tbl[task_id];
if(NULL == tcb_handle)
{
debug_write(OSP_DEBUG_POT(g_ape_id, 13), task_id);
return ;
}
task_prio = g_prio_array[task_id];
if (task_prio <= 0)
{
debug_write(OSP_DEBUG_POT(g_ape_id, 14), task_id);
return ;
}
g_task_id_array[task_prio] = 0; /* 通过优先级清任务列表 */
g_prio_array[task_id] = 0; /* 通过任务ID清优先级列表 */
FREE((char*)((tcb_handle->stack_down)-4)); /* 释放栈空间 */
osp_delete_sem(tcb_handle->sem); /* 删除信号量 */
FREE((char*)tcb_handle); /* 释放任务控制块 */
g_tcb_handler_tbl[task_id] = NULL;
for (u8_loop = 0; u8_loop < g_taskid_num; u8_loop++)
{
if (task_id == g_task_id_table[u8_loop])
{
g_task_id_table[u8_loop] = 0;
memcpy(&(g_task_id_table[u8_loop]), &(g_task_id_table[u8_loop+1]), (g_taskid_num-u8_loop-1));
g_taskid_num--;
break;
}
}
smart_task_del(task_prio); /* 删除任务 */
return ;
}
/* 任务删除
* 需要删除的内存如下：
* 1. 任务的栈空间
* 2. 任务的控制块空间
* 3. 任务的相关信号量
* 4. 任务的相关软队列
* 5. 任务的相关列表：任务优先级列表+任务ID列表
* 6. 定时点任务的相关列表
*/
void osp_del_task(int prio)
{
#ifdef UCP_TICK_ENABLE
uint32_t clockBegin,clockEnd;
int32_t clockCnt;
rdmcycle(&clockBegin);
#endif
uint8_t u8_loop = 0;
int task_id = 0;
osp_tcb *tcb_handle = NULL;
task_id = g_task_id_array[prio];
if (0 == task_id)
{
/* 任务不存在 */
UCP_PRINT_ERROR("osp_del_task: task_id = 0x%08x(prio = 0x%08x), not exsit.\r\n", task_id, prio);
debug_write(OSP_DEBUG_POT(g_ape_id, 32), task_id);
return ;
}
/* 通过任务ID找到任务控制块信息 */
tcb_handle = (osp_tcb*)g_tcb_handler_tbl[task_id];
/* 根据消息类型分别处理 */
if (OSP_TIMER_TYPE == tcb_handle->task_type)
{
/* 只要删除定时点任务，那就清空所有定时点任务相关信息 */
/* 先调用驱动接口，把定时点信息清除 */
osp_timer_clear_stctimer();
osp_timer_clear_task(); /* 遍历删除所有的定时点任务 */
osp_timer_init(); /* 清空平台的定时点任务相关信息 */
}
else if (OSP_EVENT_TYPE == tcb_handle->task_type)
{
/* 事件任务，删除事件信号量和软件队列 */
osp_delete_sem(tcb_handle->event_sem);
osp_free((char*)tcb_handle->que_head);
}
else if (OSP_NORMAL_TYPE == tcb_handle->task_type)
{
/* 无操作 */
}
else
{
/* 其他任务，删除信号量 */
osp_delete_sem(tcb_handle->sem);
}
g_task_id_array[prio] = 0; /* 通过优先级清任务列表 */
g_prio_array[task_id] = 0; /* 通过任务ID清优先级列表 */
FREE((char*)((tcb_handle->stack_down)-4)); /* 释放栈空间 */
FREE((char*)tcb_handle); /* 释放任务控制块 */
g_tcb_handler_tbl[task_id] = NULL;
for (u8_loop = 0; u8_loop < g_taskid_num; u8_loop++)
{
if (task_id == g_task_id_table[u8_loop])
{
g_task_id_table[u8_loop] = 0;
memcpy(&(g_task_id_table[u8_loop]), &(g_task_id_table[u8_loop+1]), (g_taskid_num-u8_loop-1));
g_taskid_num--;
break;
}
}
/* 删除任务 */
smart_task_del(prio);
debug_write(OSP_DEBUG_POT(g_ape_id, 33), task_id);
#ifdef UCP_TICK_ENABLE
rdmcycle(&clockEnd);
clockCnt = clockEnd - clockBegin;
debug_write(OSP_DEBUG_POT(g_ape_id, 201), clockCnt);
#endif
return ;
}
void osp_delay_cycle(int cycle)
{
smart_tick_sleep(cycle);
}
void *get_sw_queue_head(int task_id)
{
osp_tcb *l_tcb = (osp_tcb*)(TCB_GET(task_id));
//debug_write(OSP_DEBUG_POT(g_ape_id, 34), task_id);
return l_tcb->que_head;
}
int osp_get_cur_task_id()
{
int apeId = get_core_id();
int task_pro = smart_get_curprio();
if (0 >= task_pro)
{
debug_write(DBG_DDR_ERR_IDX(apeId, 24), task_pro);
}
//debug_write(OSP_DEBUG_POT(g_ape_id, 35), task_pro);
return g_task_id_array[task_pro];
}
uint8_t osp_task_id_is_true(int task_id)
{
if (g_prio_array[task_id] != 0)
{
return OSP_OK;
}
return OSP_ERROR;
}
void osp_show_task_info(void)
{
int i;
osp_tcb *tcb_val;
char pbuf[2048];
int st_top_s = 0;
int st_low_s = 0;
int stack_state = 0;
int len = 0;
uint8_t ucCoreId = 0;
ucCoreId = get_core_id();
len = sprintf(pbuf,"\n\r%-8s%-8s%-20s%10s%15s%8s%12s%12s%12s%15s%12s%12s%12s\n\r",
"coreId", "Id", "name","end_times","cpu-pri","type", "stacktop", "stackdown", "stacksize","stack_state", "run_times", "preem_task", "preem_times");
for(i=0; i< g_taskid_num; i++,len=0)
{
tcb_val = (osp_tcb*)g_tcb_handler_tbl[g_task_id_table[i]];
st_top_s = TOP_STACK_GUARD0(tcb_val->stack_top);
st_low_s = LOW_STACK_GUARD0(tcb_val->stack_down);
if((st_low_s == 0)&&(st_top_s == 0))
{
stack_state = 0;
}
else
{
stack_state = 1;
}
len += sprintf(pbuf +len,"%-8u%-5u%-20s%10u%17u%8u 0x%x 0x%x%12u\t%2u\t%12u%12u%12u\n\r",
ucCoreId,tcb_val->task_id, tcb_val->task_name, gst_osp_task_dbg_info[g_task_id_table[i]].u32Call_after,tcb_val->priority,tcb_val->task_type, tcb_val->stack_top, tcb_val->stack_down,
tcb_val->stack_size, stack_state, tcb_val->run_times, tcb_val->preem_task, tcb_val->preem_times);
spu_shellinfo_to_arm(pbuf, len, UCP4008_OSP_SHELL);
}
return;
}
Reference in New Issue Copy Permalink