正常的英雄

MDK-ARM/DevC.uvoptx

@@ -407,6 +407,11 @@
           <WinNumber>1</WinNumber>
           <ItemText>rc</ItemText>
         </Ww>
+        <Ww>
+          <count>10</count>
+          <WinNumber>1</WinNumber>
+          <ItemText>cmd_host</ItemText>
+        </Ww>
       </WatchWindow1>
       <Tracepoint>
         <THDelay>0</THDelay>
@@ -658,7 +663,7 @@
 
   <Group>
     <GroupName>Application/User/USB_DEVICE/App</GroupName>
-    <tvExp>1</tvExp>
+    <tvExp>0</tvExp>
     <tvExpOptDlg>0</tvExpOptDlg>
     <cbSel>0</cbSel>
     <RteFlg>0</RteFlg>
@@ -1214,7 +1219,7 @@
 
   <Group>
     <GroupName>Middlewares/USB_Device_Library</GroupName>
-    <tvExp>1</tvExp>
+    <tvExp>0</tvExp>
     <tvExpOptDlg>0</tvExpOptDlg>
     <cbSel>0</cbSel>
     <RteFlg>0</RteFlg>
@@ -1494,7 +1499,7 @@
 
   <Group>
     <GroupName>User/component</GroupName>
-    <tvExp>1</tvExp>
+    <tvExp>0</tvExp>
     <tvExpOptDlg>0</tvExpOptDlg>
     <cbSel>0</cbSel>
     <RteFlg>0</RteFlg>
@@ -1670,7 +1675,7 @@
 
   <Group>
     <GroupName>User/device</GroupName>
-    <tvExp>1</tvExp>
+    <tvExp>0</tvExp>
     <tvExpOptDlg>0</tvExpOptDlg>
     <cbSel>0</cbSel>
     <RteFlg>0</RteFlg>
@@ -1750,7 +1755,7 @@
 
   <Group>
     <GroupName>User/module</GroupName>
-    <tvExp>1</tvExp>
+    <tvExp>0</tvExp>
     <tvExpOptDlg>0</tvExpOptDlg>
     <cbSel>0</cbSel>
     <RteFlg>0</RteFlg>

Middlewares/Third_Party/Protocol/protocol.h

@@ -53,14 +53,12 @@ typedef struct __attribute__((packed)) {
 
 /* 视觉 -> 电控 数据结构体*/
 typedef struct __attribute__((packed)) {
-
   struct __attribute__((packed)) {
     float yaw; /* 偏航角（Yaw angle） */
     float pit; /* 俯仰角（Pitch angle） */
     float rol; /* 翻滚角（Roll angle） */
   } gimbal;    /* 欧拉角 */
 
-  float distance; /*目标距离*/
   uint8_t notice; /* 控制命令 */
 
   struct __attribute__((packed)) {

User/component/cmd.c

@@ -6,6 +6,7 @@
 
 #include <string.h>
 
+#include <device\ai.h>
 /**
  * @brief 行为转换为对应按键
  *
@@ -189,45 +190,47 @@ static void CMD_RcLogic(const CMD_RC_t *rc, CMD_t *cmd, float dt_sec) {
       /* 左拨杆相应行为选择和解析 */
     case CMD_SW_UP:
       cmd->chassis.mode = CHASSIS_MODE_BREAK;
+      // cmd->host_overwrite = false;
+      // cmd->shoot.ai_fire = false;
       break;
 
     case CMD_SW_MID:
-      cmd->chassis.mode = CHASSIS_MODE_FOLLOW_GIMBAL_35;
+      cmd->chassis.mode = CHASSIS_MODE_FOLLOW_GIMBAL;
+      // cmd->host_overwrite = true;
+      // cmd->shoot.ai_fire = false;
       break;
 
     case CMD_SW_DOWN:
       cmd->chassis.mode = CHASSIS_MODE_ROTOR;
       cmd->chassis.mode_rotor = ROTOR_MODE_CW;
+      // cmd->host_overwrite = true;
+      // cmd->shoot.ai_fire = true;
       break;
 
     case CMD_SW_ERR:
       cmd->chassis.mode = CHASSIS_MODE_RELAX;
+      // cmd->host_overwrite = false;
+      // cmd->shoot.ai_fire = false;
       break;
   }
   switch (rc->sw_r) {
       /* 右拨杆相应行为选择和解析*/ 
     case CMD_SW_UP:
       cmd->gimbal.mode = GIMBAL_MODE_ABSOLUTE;
-      // cmd->shoot.mode = SHOOT_MODE_SAFE;
+      cmd->shoot.mode = SHOOT_MODE_SAFE;
-      cmd->host_overwrite = false;
-      cmd->ai_status = AI_STATUS_STOP;
       break;
 
     case CMD_SW_MID:
       cmd->gimbal.mode = GIMBAL_MODE_ABSOLUTE;
-      cmd->host_overwrite = true;
+      cmd->shoot.fire = false;
-      cmd->ai_status = AI_STATUS_AUTOMATIC;
+      cmd->shoot.mode = SHOOT_MODE_LOADED;
-      // cmd->shoot.fire = false;
-      // cmd->shoot.mode = SHOOT_MODE_LOADED;
       break;
 
     case CMD_SW_DOWN:
       cmd->gimbal.mode = GIMBAL_MODE_ABSOLUTE;
-      cmd->host_overwrite = true;
+      cmd->shoot.mode = SHOOT_MODE_LOADED;
-      cmd->ai_status = AI_STATUS_AUTOMATIC;
+      cmd->shoot.fire_mode = FIRE_MODE_SINGLE;
-      // cmd->shoot.mode = SHOOT_MODE_LOADED;
+      cmd->shoot.fire = true;
-      // cmd->shoot.fire_mode = FIRE_MODE_SINGLE;
-      // cmd->shoot.fire = true;
       break;
 		/*
 		    case CMD_SW_UP:
@@ -250,9 +253,8 @@ static void CMD_RcLogic(const CMD_RC_t *rc, CMD_t *cmd, float dt_sec) {
 		*/
     case CMD_SW_ERR:
       cmd->gimbal.mode = GIMBAL_MODE_RELAX;
-      cmd->host_overwrite = false;
+      cmd->shoot.mode = SHOOT_MODE_RELAX;
-      cmd->ai_status = AI_STATUS_STOP;
+      // cmd->host_overwrite = false;
-      // cmd->shoot.mode = SHOOT_MODE_RELAX;
   }
   /* 将操纵杆的对应值转换为底盘的控制向量和云台变化的欧拉角 */
   cmd->chassis.ctrl_vec.vx = rc->ch_l_x;
@@ -353,11 +355,6 @@ int8_t CMD_ParseHost(const CMD_Host_t *host, CMD_t *cmd, float dt_sec) {
   cmd->gimbal.delta_eulr.yaw = host->gimbal_delta.yaw;
   cmd->gimbal.delta_eulr.pit = host->gimbal_delta.pit;
 
-  if (cmd->ai_status == AI_STATUS_AUTOMATIC){
-    cmd->chassis.ctrl_vec.vx = host->chassis_move_vec.vx;
-    cmd->chassis.ctrl_vec.vy = host->chassis_move_vec.vy;
-    cmd->chassis.ctrl_vec.wz = host->chassis_move_vec.wz;
-  }
   /* host射击命令，设置不同的射击频率和弹丸初速度 */
   if (host->fire) {
     cmd->shoot.mode = SHOOT_MODE_LOADED;

User/component/cmd.h

@@ -84,6 +84,7 @@ typedef struct {
   CMD_ShootMode_t mode;     /* 射击运行模式 */
   CMD_FireMode_t fire_mode; /* 开火模式 */
   bool fire;                /*开火*/
+  bool ai_fire; /* AI开火状态 */
   bool cover_open;          /* 弹舱盖开关 */
   bool reverse_trig;        /* 拨弹电机状态 */
 } CMD_ShootCmd_t;
@@ -212,7 +213,6 @@ typedef struct {
   } mouse_last;   /* 鼠标值 */
 
   CMD_AI_Status_t ai_status; /* AI状态 */
-
   const CMD_Params_t *param; /* 命令参数 */
 
   CMD_ChassisCmd_t chassis; /* 底盘控制命令 */

User/component/user_math.c

@@ -112,17 +112,3 @@ inline float CalculateRpm(float bullet_speed, float fric_radius, bool is17mm) {
   /* 不为裁判系统设定值时,计算转速 */
   return 60.0f * (float)bullet_speed / (M_2PI * fric_radius);
 }
-
-/**
- * @brief 断言失败处理
- *
- * @param file 文件名
- * @param line 行号
- */
-void VerifyFailed(const char *file, uint32_t line) {
-  UNUSED(file);
-  UNUSED(line);
-  while (1) {
-    __NOP();
-  }
-}

User/component/user_math.h

@@ -104,53 +104,3 @@ float CalculateRpm(float bullet_speed, float fric_radius, bool is17mm);
 #ifdef __cplusplus
 }
 #endif
-
-#ifdef DEBUG
-
-/**
- * @brief 如果表达式的值为假则运行处理函数
- *
- */
-#define ASSERT(expr)                    \
-  do {                                  \
-    if (!(expr)) {                      \
-      VerifyFailed(__FILE__, __LINE__); \
-    }                                   \
-  } while (0)
-#else
-
-/**
- * @brief 未定DEBUG，表达式不会运行，断言被忽略
- *
- */
-#define ASSERT(expr) ((void)(0))
-#endif
-
-#ifdef DEBUG
-
-/**
- * @brief 如果表达式的值为假则运行处理函数
- *
- */
-#define VERIFY(expr)                    \
-  do {                                  \
-    if (!(expr)) {                      \
-      VerifyFailed(__FILE__, __LINE__); \
-    }                                   \
-  } while (0)
-#else
-
-/**
- * @brief 表达式会运行，忽略表达式结果
- *
- */
-#define VERIFY(expr) ((void)(expr))
-#endif
-
-/**
- * @brief 断言失败处理
- *
- * @param file 文件名
- * @param line 行号
- */
-void VerifyFailed(const char *file, uint32_t line);

User/device/ai.c

@@ -14,17 +14,11 @@
 #include "component\user_math.h"
 
 /* Private define ----------------------------------------------------------- */
-#define AI_HOST_MAX_CONTROL_VALUE (1.0f)
-
-#define AI_LEN_RX_BUFF (sizeof(Protocol_DownPackage_t))
-
 /* Private macro ------------------------------------------------------------ */
 /* Private typedef ---------------------------------------------------------- */
 /* Private variables -------------------------------------------------------- */
 static volatile uint32_t drop_message = 0;
 
-static uint8_t rxbuf[AI_LEN_RX_BUFF];
-
 static osThreadId_t thread_alert;
 
 static bool inited = false;
@@ -35,22 +29,17 @@ static void Ai_RxCpltCallback(void) {
   osThreadFlagsSet(thread_alert, SIGNAL_AI_RAW_REDY);
 }
 
-static void Ai_IdleLineCallback(void) {
-  osThreadFlagsSet(thread_alert, SIGNAL_AI_RAW_REDY);
-}
-
 /* Exported functions ------------------------------------------------------- */
 int8_t AI_Init(AI_t *ai) {
-  UNUSED(ai);
+  if (ai == NULL) return DEVICE_ERR_NULL;
-  ASSERT(ai);
   if (inited) return DEVICE_ERR_INITED;
-  VERIFY((thread_alert = osThreadGetId()) != NULL);
+  if ((thread_alert = osThreadGetId()) == NULL) return DEVICE_ERR_NULL;
 
   BSP_UART_RegisterCallback(BSP_UART_AI, BSP_UART_RX_CPLT_CB,
                             Ai_RxCpltCallback);
-  BSP_UART_RegisterCallback(BSP_UART_AI, BSP_UART_IDLE_LINE_CB,
-                            Ai_IdleLineCallback);
   inited = true;
+
+  ai->ai_online = false;
   return 0;
 }
 
@@ -61,9 +50,9 @@ int8_t AI_Restart(void) {
 }
 
 int8_t AI_StartReceiving(AI_t *ai) {
-  UNUSED(ai);
+  if (HAL_UART_Receive_DMA(BSP_UART_GetHandle(BSP_UART_AI),
-  if (HAL_UART_Receive_DMA(BSP_UART_GetHandle(BSP_UART_AI), rxbuf,
+                           ai->form_host.rx_buffer,
-                           AI_LEN_RX_BUFF) == HAL_OK)
+                           sizeof(ai->form_host.rx_buffer)) == HAL_OK)
     return DEVICE_OK;
   return DEVICE_ERR;
 }
@@ -73,12 +62,27 @@ bool AI_WaitDmaCplt(void) {
           SIGNAL_AI_RAW_REDY);
 }
 
-int8_t AI_ParseHost(AI_t *ai) {
+int8_t AI_ParseHost(AI_t *ai, CMD_Host_t *cmd_host) {
-  if (!CRC16_Verify((const uint8_t *)&(rxbuf), sizeof(ai->form_host)))
+  (void)cmd_host;
-    goto error;
   ai->ai_online = true;
-  memcpy(&(ai->form_host), rxbuf, sizeof(ai->form_host));
+  if (!CRC16_Verify(ai->form_host.rx_buffer, sizeof(ai->form_host.rx_buffer)))
-  memset(rxbuf, 0, AI_LEN_RX_BUFF);
+    goto error;
+  memcpy(&(ai->form_host.data), ai->form_host.rx_buffer, sizeof(ai->form_host.data));
+  // cmd_host->gimbal_delta.pit = ai->form_host.data.gimbal.pit;
+  // cmd_host->gimbal_delta.yaw = ai->form_host.data.gimbal.yaw;
+  // cmd_host->gimbal_delta.rol = ai->form_host.data.gimbal.rol;
+  // cmd_host->fire = (ai->form_host.data.notice & AI_NOTICE_FIRE);
+  // cmd_host->chassis_move_vec.vx = ai->form_host.data.chassis_move_vec.vx;
+  // cmd_host->chassis_move_vec.vy = ai->form_host.data.chassis_move_vec.vy;
+  // cmd_host->chassis_move_vec.wz = ai->form_host.data.chassis_move_vec.wz;
+  cmd_host->gimbal_delta.pit = ai->form_host.data.data.gimbal.pit;
+  cmd_host->gimbal_delta.yaw = ai->form_host.data.data.gimbal.yaw;
+  cmd_host->gimbal_delta.rol = ai->form_host.data.data.gimbal.rol;
+  cmd_host->fire = (ai->form_host.data.data.notice & AI_NOTICE_FIRE);
+  cmd_host->chassis_move_vec.vx = ai->form_host.data.data.chassis_move_vec.vx;
+  cmd_host->chassis_move_vec.vy = ai->form_host.data.data.chassis_move_vec.vy;
+  cmd_host->chassis_move_vec.wz = ai->form_host.data.data.chassis_move_vec.wz;
+
   return DEVICE_OK;
 
 error:
@@ -86,26 +90,12 @@ error:
   return DEVICE_ERR;
 }
 
-void AI_PackCmd(AI_t *ai, CMD_Host_t *cmd_host) {
-  cmd_host->gimbal_delta.yaw = -ai->form_host.data.gimbal.yaw;
-  cmd_host->gimbal_delta.pit = -ai->form_host.data.gimbal.pit;
-
-  Clip(&(cmd_host->gimbal_delta.yaw), -AI_HOST_MAX_CONTROL_VALUE,
-        AI_HOST_MAX_CONTROL_VALUE);
-  Clip(&(cmd_host->gimbal_delta.pit), -AI_HOST_MAX_CONTROL_VALUE,
-        AI_HOST_MAX_CONTROL_VALUE);
-
-  cmd_host->fire = (ai->form_host.data.notice & AI_NOTICE_FIRE);
-  cmd_host->chassis_move_vec.vx = ai->form_host.data.chassis_move_vec.vx;
-  cmd_host->chassis_move_vec.vy = ai->form_host.data.chassis_move_vec.vy;
-  cmd_host->chassis_move_vec.wz = ai->form_host.data.chassis_move_vec.wz;
-}
-
 int8_t AI_HandleOffline(AI_t *ai, CMD_Host_t *cmd_host) {
   if (ai == NULL) return DEVICE_ERR_NULL;
   if (cmd_host == NULL) return DEVICE_ERR_NULL;
   ai->ai_online = false;
-  memset(&(ai->form_host), 0, sizeof(ai->form_host));
+  memset(ai->form_host.rx_buffer, 0, sizeof(ai->form_host.rx_buffer));
+  memset(&(ai->form_host.data), 0, sizeof(ai->form_host.data));
   memset(cmd_host, 0, sizeof(*cmd_host));
   return 0;
 }

User/device/ai.h

@@ -36,8 +36,10 @@ typedef struct __packed {
 
 typedef struct __packed {
   osThreadId_t thread_alert;
-
+  struct {
-  Protocol_DownPackage_t form_host;
+    uint8_t rx_buffer[sizeof(Protocol_DownPackage_t)]; 
+    Protocol_DownPackage_t data;
+  }form_host;
 
   struct {
     AI_UpPackageReferee_t ref;
@@ -45,6 +47,7 @@ typedef struct __packed {
   } to_host;
 
   CMD_AI_Status_t status;
+
   bool ai_online;
 } AI_t;
 
@@ -54,12 +57,11 @@ int8_t AI_Restart(void);
 
 int8_t AI_StartReceiving(AI_t *ai);
 bool AI_WaitDmaCplt(void);
-int8_t AI_ParseHost(AI_t *ai);
+int8_t AI_ParseHost(AI_t *ai, CMD_Host_t *cmd_host);
 int8_t AI_HandleOffline(AI_t *ai, CMD_Host_t *cmd_host);
 int8_t AI_PackMCU(AI_t *ai, const AHRS_Quaternion_t *quat);
 int8_t AI_PackRef(AI_t *ai, const Referee_ForAI_t *ref);
 int8_t AI_StartSend(AI_t *ai, bool option);
-void AI_PackCmd(AI_t *ai, CMD_Host_t *cmd_host);
 #ifdef __cplusplus
 }
 #endif

User/module/chassis.c

@@ -264,7 +264,7 @@ int8_t Chassis_Control(Chassis_t *c, const CMD_ChassisCmd_t *c_cmd,
 
     case CHASSIS_MODE_INDENPENDENT: /* 独立模式控制向量与运动向量相等 */
       c->move_vec.vx = c_cmd->ctrl_vec.vx;
-      c->move_vec.vy = c_cmd->ctrl_vec.vy;
+      c->move_vec.vy = c_cmd->ctrl_vec.vx;
       break;
 
     case CHASSIS_MODE_OPEN:

User/module/config.c

@@ -202,7 +202,11 @@ static const Config_RobotParam_t param_default = {
     }, /* can */
 }; /* param_default */
 
+#ifdef DEBUG
+Config_RobotParam_t param_hero = {
+#else
 static const Config_RobotParam_t param_hero = {
+#endif
   .model = ROBOT_MODEL_HERO,
 
   .chassis = { /* 底盘模块参数 */
@@ -236,7 +240,7 @@ static const Config_RobotParam_t param_hero = {
     },
 		
 		.reverse = {
-			.yaw = true,
+			.yaw = false,
 		},
   }, /* chassis */
 
@@ -285,7 +289,7 @@ static const Config_RobotParam_t param_hero = {
       },
     }, /* pid */
 
-		.pitch_travel_rad = 1.07685447f,
+		.pitch_travel_rad = 0.9685447f,
     
     .low_pass_cutoff_freq = {
       .out = -1.0f,
@@ -293,8 +297,8 @@ static const Config_RobotParam_t param_hero = {
     },
 
     .reverse = {
-      .yaw = true,
+      .yaw = false,
-      .pit = true,
+      .pit = false,
     },
 
     .pit_ctrl_reverse = false,
@@ -331,8 +335,8 @@ static const Config_RobotParam_t param_hero = {
         .trig = -1.0f,
       },
     },
-    .num_trig_tooth = 6.0f,
+    .num_trig_tooth = 5.0f,
-    .trig_gear_ratio = 3591.0f / 187.0f,
+    .trig_gear_ratio = 19.0f,
     .fric_radius = 0.03f,
     .cover_open_duty = 0.125f,
     .cover_close_duty = 0.075f,

User/module/gimbal.c

@@ -130,39 +130,37 @@ int8_t Gimbal_Control(Gimbal_t *g, CMD_GimbalCmd_t *g_cmd, uint32_t now) {
   Gimbal_SetMode(g, g_cmd->mode);
 
   /* yaw坐标正方向与遥控器操作逻辑相反 */
-  // g_cmd->delta_eulr.pit = g_cmd->delta_eulr.pit;
-  // if (g->param->pit_ctrl_reverse){
-  //   g_cmd->delta_eulr.yaw = g_cmd->delta_eulr.yaw;
-  // }else{
-  //   g_cmd->delta_eulr.yaw = -g_cmd->delta_eulr.yaw;
-  // }
   g_cmd->delta_eulr.pit = g_cmd->delta_eulr.pit;
+  if (g->param->pit_ctrl_reverse){
     g_cmd->delta_eulr.yaw = -g_cmd->delta_eulr.yaw;
+  }else{
+    g_cmd->delta_eulr.yaw = -g_cmd->delta_eulr.yaw;
+  }
 
   /* 处理yaw控制命令 */
   CircleAdd(&(g->setpoint.eulr.yaw), g_cmd->delta_eulr.yaw, M_2PI);
 
   /* 处理pitch控制命令，软件限位 */
-  // const float delta_max =
-  //     CircleError(g->limit.max,
-  //                 (g->feedback.eulr.encoder.pit + g->setpoint.eulr.pit -
-  //                  g->feedback.eulr.imu.pit),
-  //                 M_2PI);
-  // const float delta_min =
-  //     CircleError(g->limit.min,
-  //                 (g->feedback.eulr.encoder.pit + g->setpoint.eulr.pit -
-  //                  g->feedback.eulr.imu.pit),
-  //                 M_2PI);
   const float delta_max =
       CircleError(g->limit.max,
                   (g->feedback.eulr.encoder.pit + g->setpoint.eulr.pit -
-                   g->feedback.eulr.encoder.pit),
+                   g->feedback.eulr.imu.pit),
                   M_2PI);
   const float delta_min =
       CircleError(g->limit.min,
                   (g->feedback.eulr.encoder.pit + g->setpoint.eulr.pit -
-                   g->feedback.eulr.encoder.pit),
+                   g->feedback.eulr.imu.pit),
                   M_2PI);
+  // const float delta_max =
+  //     CircleError(g->limit.max,
+  //                 (g->feedback.eulr.encoder.pit + g->setpoint.eulr.pit -
+  //                  g->feedback.eulr.encoder.pit),
+  //                 M_2PI);
+  // const float delta_min =
+  //     CircleError(g->limit.min,
+  //                 (g->feedback.eulr.encoder.pit + g->setpoint.eulr.pit -
+  //                  g->feedback.eulr.encoder.pit),
+  //                 M_2PI);
   Clip(&(g_cmd->delta_eulr.pit), delta_min, delta_max);
   g->setpoint.eulr.pit += g_cmd->delta_eulr.pit;
 
@@ -184,16 +182,20 @@ int8_t Gimbal_Control(Gimbal_t *g, CMD_GimbalCmd_t *g_cmd, uint32_t now) {
           PID_Calc(&(g->pid[GIMBAL_PID_YAW_OMEGA_IDX]), yaw_omega_set_point,
                    g->feedback.gyro.z, 0.f, g->dt);
 
-      // pit_omega_set_point =
-      //     PID_Calc(&(g->pid[GIMBAL_PID_PIT_ANGLE_IDX]), g->setpoint.eulr.pit,
-      //              g->feedback.eulr.imu.pit, 0.0f, g->dt);
       pit_omega_set_point =
           PID_Calc(&(g->pid[GIMBAL_PID_PIT_ANGLE_IDX]), g->setpoint.eulr.pit,
-                   g->feedback.eulr.encoder.pit, 0.0f, g->dt);
+                   g->feedback.eulr.imu.pit, 0.0f, g->dt);
+      // pit_omega_set_point =
+      //     PID_Calc(&(g->pid[GIMBAL_PID_PIT_ANGLE_IDX]), g->setpoint.eulr.pit,
+      //              g->feedback.eulr.encoder.pit, 0.0f, g->dt);
            
       g->out[GIMBAL_ACTR_PIT_IDX] =
           PID_Calc(&(g->pid[GIMBAL_PID_PIT_OMEGA_IDX]), pit_omega_set_point,
-                   0.0, 0.f, g->dt);
+                   g->feedback.gyro.x, 0.f, g->dt);
+      
+      // g->out[GIMBAL_ACTR_PIT_IDX] =
+      //     PID_Calc(&(g->pid[GIMBAL_PID_PIT_OMEGA_IDX]), pit_omega_set_point,
+      //              0.0, 0.f, g->dt);
       break;
 
     case GIMBAL_MODE_RELATIVE:

User/module/shoot.c

@@ -252,9 +252,9 @@ int8_t Shoot_Control(Shoot_t *s, CMD_ShootCmd_t *s_cmd,
 
   float fric_rpm = CalculateRpm(s->fire_ctrl.bullet_speed, s->param->fric_radius,
                                 (s->param->model == SHOOT_MODEL_17MM));
-  s->setpoint.fric_rpm[0] = fric_rpm;
+  s->setpoint.fric_rpm[0] = -fric_rpm;
-  s->setpoint.fric_rpm[1] = -fric_rpm;
+  s->setpoint.fric_rpm[1] = fric_rpm;
-  s->setpoint.fric_rpm[2] = fric_rpm;
+  s->setpoint.fric_rpm[2] = -fric_rpm;
 
   /* 计算拨弹电机位置的目标值 */
   if (((now - s->fire_ctrl.last_shoot) >= s->fire_ctrl.period_ms) &&

User/task/ai.c

@@ -42,7 +42,9 @@ void Task_Ai(void *argument) {
   AI_Init(&ai);
 
   uint32_t tick = osKernelGetTickCount();
+
   uint32_t last_online_tick = tick;
+
   while (1) {
 #ifdef DEBUG
     task_runtime.stack_water_mark.ai = osThreadGetStackSpace(osThreadGetId());
@@ -52,23 +54,18 @@ void Task_Ai(void *argument) {
 
     AI_StartReceiving(&ai);
     if (AI_WaitDmaCplt()) {
-      AI_ParseHost(&ai);
+      AI_ParseHost(&ai, &cmd_host);
       last_online_tick = tick;
     } else {
       if (tick - last_online_tick > 300) AI_HandleOffline(&ai, &cmd_host);
     }
-
-    if (ai.status != AI_STATUS_STOP && ai.ai_online){
-      AI_PackCmd(&ai, &cmd_host);
     osMessageQueueReset(task_runtime.msgq.cmd.raw.host);
     osMessageQueuePut(task_runtime.msgq.cmd.raw.host, &(cmd_host), 0, 0);
-    }
 
     osMessageQueueGet(task_runtime.msgq.ai.quat, &(quat), NULL, 0);
     osMessageQueueGet(task_runtime.msgq.cmd.ai, &(ai.status), NULL, 0);
     bool ref_update = (osMessageQueueGet(task_runtime.msgq.referee.ai,
                                          &(referee_ai), NULL, 0) == osOK);
-    
     AI_PackMCU(&ai, &quat);
     if (ref_update) AI_PackRef(&ai, &(referee_ai));
 

User/task/cli.c

@@ -32,10 +32,10 @@ typedef struct {
 
 static const char *const CLI_WELCOME_MESSAGE =
     "\r\n"
-//    "  ______         __           _______               __              \r\n"
+   "  ______         __           _______               __              \r\n"
-//    " |   __ \\.-----.|  |--.-----.|   |   |.---.-.-----.|  |_.-----.----.\r\n"
+   " |   __ \\.-----.|  |--.-----.|   |   |.---.-.-----.|  |_.-----.----.\r\n"
-//    " |      <|  _  ||  _  |  _  ||       ||  _  |__ --||   _|  -__|   _|\r\n"
+   " |      <|  _  ||  _  |  _  ||       ||  _  |__ --||   _|  -__|   _|\r\n"
-//    " |___|__||_____||_____|_____||__|_|__||___._|_____||____|_____|__|  \r\n"
+   " |___|__||_____||_____|_____||__|_|__||___._|_____||____|_____|__|  \r\n"
     " -------------------------------------------------------------------\r\n"
     " FreeRTOS CLI. Type 'help' to view a list of registered commands.   \r\n"
     "\r\n";