73 lines
1.8 KiB
C
73 lines
1.8 KiB
C
|
#include "user_task.h"
|
|||
|
|
#include "cmd.h"
|
|||
|
|
|
|||
|
|
#ifdef DEBUG
|
|||
|
|
|
|||
|
|
CMD_t cmd;
|
|||
|
|
CMD_RC_t rc_ctrl;
|
|||
|
|
CMD_NUC_t Nuc;
|
|||
|
|
CMD_ACTION_t cmd_ops_out;
|
|||
|
|
|
|||
|
|
#else
|
|||
|
|
|
|||
|
|
static CMD_t cmd;
|
|||
|
|
static CMD_RC_t rc_ctrl;
|
|||
|
|
static CMD_NUC_t Nuc;
|
|||
|
|
static CMD_ACTION_t cmd_ops_out;
|
|||
|
|
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
void Task_cmd(void *argument){
|
|||
|
|
(void)argument; /*未使用传递参数 消除警告*/
|
|||
|
|
|
|||
|
|
/* 计算到下一次调度任务所需要的tick数 */
|
|||
|
|
const uint32_t delay_tick = osKernelGetTickFreq() / TASK_FREQ_CTRL_CMD;
|
|||
|
|
/**/
|
|||
|
|
CMD_Init(&cmd);
|
|||
|
|
|
|||
|
|
uint32_t tick = osKernelGetTickCount(); /*控制任务运行频率的计时 */
|
|||
|
|
while(1){
|
|||
|
|
#ifdef DEBUG
|
|||
|
|
/*记录任务所需要的栈空间*/
|
|||
|
|
task_runtime.stack_water_mark.cmd =
|
|||
|
|
osThreadGetStackSpace(osThreadGetId());
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
osKernelLock(); /*锁住RTOS内核调度*/
|
|||
|
|
|
|||
|
|
/*将各任务接收到的原始数据解析为通用的控制命令*/
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
/*注意，不能将nuc和码盘导航一块使用*/
|
|||
|
|
|
|||
|
|
if(osMessageQueueGet(task_runtime.msgq.cmd.raw.nuc, &Nuc,0 ,0) ==osOK) //nuc
|
|||
|
|
CMD_ParseNuc(&cmd,&Nuc);
|
|||
|
|
|
|||
|
|
CMD_CtrlSet(&cmd);
|
|||
|
|
|
|||
|
|
if(osMessageQueueGet(task_runtime.msgq.cmd.raw.rc, &rc_ctrl, 0, 0) == osOK)//遥控器
|
|||
|
|
CMD_ParseRc(&cmd, &rc_ctrl);
|
|||
|
|
|
|||
|
|
if(osMessageQueueGet(task_runtime.msgq.cmd.raw .ops_9_out , &cmd_ops_out, 0, 0) == osOK)//码盘
|
|||
|
|
CMD_ParseAction (&cmd ,&cmd_ops_out);
|
|||
|
|
osKernelUnlock(); /* 同上 解锁RTOS内核 */
|
|||
|
|
|
|||
|
|
/*将需要与其他任务共享的数据放到消息队列里 此处主要分享给底盘 后续会添加和上层机构的通信 */
|
|||
|
|
osMessageQueueReset(task_runtime.msgq.cmd.chassis);
|
|||
|
|
osMessageQueuePut(task_runtime.msgq.cmd.chassis,&cmd,0,0);
|
|||
|
|
|
|||
|
|
tick += delay_tick; /*计算下一个唤醒时刻*/
|
|||
|
|
osDelayUntil(tick); /*绝对延时 等待下一个唤醒时刻 */
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
|