添加088

User/device/bmi088.c

@@ -0,0 +1,381 @@
+/*
+     BMI088 陀螺仪+加速度计传感器。
+*/
+
+/* Includes ----------------------------------------------------------------- */
+#include "bmi088.h"
+
+#include <cmsis_os2.h>
+#include <gpio.h>
+#include <stdbool.h>
+#include <string.h>
+
+#include "bsp/time.h"
+#include "bsp/gpio.h"
+#include "bsp/spi.h"
+#include "component/user_math.h"
+
+/* USER INCLUDE BEGIN */
+
+/* USER INCLUDE END */
+
+/* Private define ----------------------------------------------------------- */
+/* Private define ----------------------------------------------------------- */
+#define BMI088_REG_ACCL_CHIP_ID (0x00)
+#define BMI088_REG_ACCL_ERR (0x02)
+#define BMI088_REG_ACCL_STATUS (0x03)
+#define BMI088_REG_ACCL_X_LSB (0x12)
+#define BMI088_REG_ACCL_X_MSB (0x13)
+#define BMI088_REG_ACCL_Y_LSB (0x14)
+#define BMI088_REG_ACCL_Y_MSB (0x15)
+#define BMI088_REG_ACCL_Z_LSB (0x16)
+#define BMI088_REG_ACCL_Z_MSB (0x17)
+#define BMI088_REG_ACCL_SENSORTIME_0 (0x18)
+#define BMI088_REG_ACCL_SENSORTIME_1 (0x19)
+#define BMI088_REG_ACCL_SENSORTIME_2 (0x1A)
+#define BMI088_REG_ACCL_INT_STAT_1 (0x1D)
+#define BMI088_REG_ACCL_TEMP_MSB (0x22)
+#define BMI088_REG_ACCL_TEMP_LSB (0x23)
+#define BMI088_REG_ACCL_CONF (0x40)
+#define BMI088_REG_ACCL_RANGE (0x41)
+#define BMI088_REG_ACCL_INT1_IO_CONF (0x53)
+#define BMI088_REG_ACCL_INT2_IO_CONF (0x54)
+#define BMI088_REG_ACCL_INT1_INT2_MAP_DATA (0x58)
+#define BMI088_REG_ACCL_SELF_TEST (0x6D)
+#define BMI088_REG_ACCL_PWR_CONF (0x7C)
+#define BMI088_REG_ACCL_PWR_CTRL (0x7D)
+#define BMI088_REG_ACCL_SOFTRESET (0x7E)
+
+#define BMI088_REG_GYRO_CHIP_ID (0x00)
+#define BMI088_REG_GYRO_X_LSB (0x02)
+#define BMI088_REG_GYRO_X_MSB (0x03)
+#define BMI088_REG_GYRO_Y_LSB (0x04)
+#define BMI088_REG_GYRO_Y_MSB (0x05)
+#define BMI088_REG_GYRO_Z_LSB (0x06)
+#define BMI088_REG_GYRO_Z_MSB (0x07)
+#define BMI088_REG_GYRO_INT_STAT_1 (0x0A)
+#define BMI088_REG_GYRO_RANGE (0x0F)
+#define BMI088_REG_GYRO_BANDWIDTH (0x10)
+#define BMI088_REG_GYRO_LPM1 (0x11)
+#define BMI088_REG_GYRO_SOFTRESET (0x14)
+#define BMI088_REG_GYRO_INT_CTRL (0x15)
+#define BMI088_REG_GYRO_INT3_INT4_IO_CONF (0x16)
+#define BMI088_REG_GYRO_INT3_INT4_IO_MAP (0x18)
+#define BMI088_REG_GYRO_SELF_TEST (0x3C)
+
+#define BMI088_CHIP_ID_ACCL (0x1E)
+#define BMI088_CHIP_ID_GYRO (0x0F)
+
+#define BMI088_LEN_RX_BUFF (19)
+/* Private macro ------------------------------------------------------------ */
+#define BMI088_ACCL_NSS_SET() \
+  BSP_GPIO_WritePin(BSP_GPIO_ACCL_CS, GPIO_PIN_SET)
+#define BMI088_ACCL_NSS_RESET() \
+  BSP_GPIO_WritePin(BSP_GPIO_ACCL_CS, GPIO_PIN_RESET)
+
+#define BMI088_GYRO_NSS_SET() \
+  BSP_GPIO_WritePin(BSP_GPIO_GYRO_CS, GPIO_PIN_SET)
+#define BMI088_GYRO_NSS_RESET() \
+  BSP_GPIO_WritePin(BSP_GPIO_GYRO_CS, GPIO_PIN_RESET)
+
+/* Private typedef ---------------------------------------------------------- */
+typedef enum {
+  BMI_ACCL,
+  BMI_GYRO,
+} BMI_Device_t;
+
+/* USER STRUCT BEGIN */
+
+/* USER STRUCT END */
+
+/* Private variables -------------------------------------------------------- */
+static uint8_t buffer[2];
+static uint8_t bmi088_rxbuf[BMI088_LEN_RX_BUFF];
+
+static osThreadId_t thread_alert;
+static bool inited = false;
+
+/* Private function  -------------------------------------------------------- */
+/* USER FUNCTION BEGIN */
+
+/* USER FUNCTION END */
+
+static void BMI_WriteSingle(BMI_Device_t dv, uint8_t reg, uint8_t data) {
+  buffer[0] = (reg & 0x7f);
+  buffer[1] = data;
+
+  BSP_TIME_Delay(1);
+  switch (dv) {
+    case BMI_ACCL:
+      BMI088_ACCL_NSS_RESET();
+      break;
+
+    case BMI_GYRO:
+      BMI088_GYRO_NSS_RESET();
+      break;
+  }
+
+  BSP_SPI_Transmit(BSP_SPI_BMI088, buffer, 2u, false);
+
+  switch (dv) {
+    case BMI_ACCL:
+      BMI088_ACCL_NSS_SET();
+      break;
+
+    case BMI_GYRO:
+      BMI088_GYRO_NSS_SET();
+      break;
+  }
+}
+
+static uint8_t BMI_ReadSingle(BMI_Device_t dv, uint8_t reg) {
+  BSP_TIME_Delay(1);
+  switch (dv) {
+    case BMI_ACCL:
+      BMI088_ACCL_NSS_RESET();
+      break;
+
+    case BMI_GYRO:
+      BMI088_GYRO_NSS_RESET();
+      break;
+  }
+  buffer[0] = (uint8_t)(reg | 0x80);
+  BSP_SPI_Transmit(BSP_SPI_BMI088, buffer, 1u, false);
+  BSP_SPI_Receive(BSP_SPI_BMI088, buffer, 2u, false);
+
+  switch (dv) {
+    case BMI_ACCL:
+      BMI088_ACCL_NSS_SET();
+      return buffer[1];
+
+    case BMI_GYRO:
+      BMI088_GYRO_NSS_SET();
+      return buffer[0];
+  }
+}
+
+static void BMI_Read(BMI_Device_t dv, uint8_t reg, uint8_t *data, uint8_t len) {
+  if (data == NULL) return;
+
+  switch (dv) {
+    case BMI_ACCL:
+      BMI088_ACCL_NSS_RESET();
+      break;
+
+    case BMI_GYRO:
+      BMI088_GYRO_NSS_RESET();
+      break;
+  }
+  buffer[0] = (uint8_t)(reg | 0x80);
+  BSP_SPI_Transmit(BSP_SPI_BMI088, buffer, 1u, false); 
+  BSP_SPI_Receive(BSP_SPI_BMI088, data, len, true);
+}
+
+static void BMI088_RxCpltCallback(void) {
+  if (BSP_GPIO_ReadPin(BSP_GPIO_ACCL_CS) == GPIO_PIN_RESET) {
+    BMI088_ACCL_NSS_SET();
+    osThreadFlagsSet(thread_alert, SIGNAL_BMI088_ACCL_RAW_REDY);
+  }
+  if (BSP_GPIO_ReadPin(BSP_GPIO_GYRO_CS) == GPIO_PIN_RESET) {
+    BMI088_GYRO_NSS_SET();
+    osThreadFlagsSet(thread_alert, SIGNAL_BMI088_GYRO_RAW_REDY);
+  }
+}
+
+static void BMI088_AcclIntCallback(void) {
+  osThreadFlagsSet(thread_alert, SIGNAL_BMI088_ACCL_NEW_DATA);
+}
+
+static void BMI088_GyroIntCallback(void) {
+  osThreadFlagsSet(thread_alert, SIGNAL_BMI088_GYRO_NEW_DATA);
+}
+
+/* Exported functions ------------------------------------------------------- */
+int8_t BMI088_Init(BMI088_t *bmi088, const BMI088_Cali_t *cali) {
+  if (bmi088 == NULL) return DEVICE_ERR_NULL;
+  if (cali == NULL) return DEVICE_ERR_NULL;
+  if (inited) return DEVICE_ERR_INITED;
+  if ((thread_alert = osThreadGetId()) == NULL) return DEVICE_ERR_NULL;
+
+  bmi088->cali = cali;
+
+  BMI_WriteSingle(BMI_ACCL, BMI088_REG_ACCL_SOFTRESET, 0xB6);
+  BMI_WriteSingle(BMI_GYRO, BMI088_REG_GYRO_SOFTRESET, 0xB6);
+  BSP_TIME_Delay(30);
+
+  /* Switch accl to SPI mode. */
+  BMI_ReadSingle(BMI_ACCL, BMI088_CHIP_ID_ACCL);
+
+  if (BMI_ReadSingle(BMI_ACCL, BMI088_REG_ACCL_CHIP_ID) != BMI088_CHIP_ID_ACCL)
+    return DEVICE_ERR_NO_DEV;
+
+  if (BMI_ReadSingle(BMI_GYRO, BMI088_REG_GYRO_CHIP_ID) != BMI088_CHIP_ID_GYRO)
+    return DEVICE_ERR_NO_DEV;
+
+  BSP_GPIO_DisableIRQ(BSP_GPIO_ACCL_INT);
+  BSP_GPIO_DisableIRQ(BSP_GPIO_GYRO_INT);
+
+  BSP_SPI_RegisterCallback(BSP_SPI_BMI088, BSP_SPI_RX_CPLT_CB,
+                           BMI088_RxCpltCallback);
+  BSP_GPIO_RegisterCallback(BSP_GPIO_ACCL_INT, BMI088_AcclIntCallback);
+  BSP_GPIO_RegisterCallback(BSP_GPIO_GYRO_INT, BMI088_GyroIntCallback);
+
+  /* Accl init. */
+  /* Filter setting: Normal. */
+  /* ODR: 0xAB: 800Hz. 0xAA: 400Hz. 0xA9: 200Hz. 0xA8: 100Hz. 0xA6: 25Hz. */
+  BMI_WriteSingle(BMI_ACCL, BMI088_REG_ACCL_CONF, 0xAA);
+
+  /* 0x00: +-3G. 0x01: +-6G. 0x02: +-12G. 0x03: +-24G. */
+  BMI_WriteSingle(BMI_ACCL, BMI088_REG_ACCL_RANGE, 0x01);
+
+  /* INT1 as output. Push-pull. Active low. Output. */
+  BMI_WriteSingle(BMI_ACCL, BMI088_REG_ACCL_INT1_IO_CONF, 0x08);
+
+  /* Map data ready interrupt to INT1. */
+  BMI_WriteSingle(BMI_ACCL, BMI088_REG_ACCL_INT1_INT2_MAP_DATA, 0x04);
+
+  /* Turn on accl. Now we can read data. */
+  BMI_WriteSingle(BMI_ACCL, BMI088_REG_ACCL_PWR_CTRL, 0x04);
+  BSP_TIME_Delay(50);
+
+  /* Gyro init. */
+  /* 0x00: +-2000. 0x01: +-1000. 0x02: +-500. 0x03: +-250. 0x04: +-125. */
+  BMI_WriteSingle(BMI_GYRO, BMI088_REG_GYRO_RANGE, 0x01);
+
+  /* Filter bw: 47Hz. */
+  /* ODR: 0x02: 1000Hz. 0x03: 400Hz. 0x06: 200Hz. 0x07: 100Hz. */
+  BMI_WriteSingle(BMI_GYRO, BMI088_REG_GYRO_BANDWIDTH, 0x03);
+
+  /* INT3 and INT4 as output. Push-pull. Active low. */
+  BMI_WriteSingle(BMI_GYRO, BMI088_REG_GYRO_INT3_INT4_IO_CONF, 0x00);
+
+  /* Map data ready interrupt to INT3. */
+  BMI_WriteSingle(BMI_GYRO, BMI088_REG_GYRO_INT3_INT4_IO_MAP, 0x01);
+
+  /* Enable new data interrupt. */
+  BMI_WriteSingle(BMI_GYRO, BMI088_REG_GYRO_INT_CTRL, 0x80);
+
+  BSP_TIME_Delay(10);
+
+  inited = true;
+
+  BSP_GPIO_EnableIRQ(BSP_GPIO_ACCL_INT);
+  BSP_GPIO_EnableIRQ(BSP_GPIO_GYRO_INT);
+  return DEVICE_OK;
+}
+
+bool BMI088_GyroStable(AHRS_Gyro_t *gyro) {
+  return ((gyro->x < 0.03f) && (gyro->y < 0.03f) && (gyro->z < 0.03f));
+}
+
+uint32_t BMI088_WaitNew() {
+  return osThreadFlagsWait(
+      SIGNAL_BMI088_ACCL_NEW_DATA | SIGNAL_BMI088_GYRO_NEW_DATA, osFlagsWaitAll,
+      osWaitForever);
+}
+
+int8_t BMI088_AcclStartDmaRecv() {
+  BMI_Read(BMI_ACCL, BMI088_REG_ACCL_X_LSB, bmi088_rxbuf, BMI088_LEN_RX_BUFF);
+  return DEVICE_OK;
+}
+
+uint32_t BMI088_AcclWaitDmaCplt() {
+  return osThreadFlagsWait(SIGNAL_BMI088_ACCL_RAW_REDY, osFlagsWaitAll,
+                           osWaitForever);
+}
+
+int8_t BMI088_GyroStartDmaRecv() {
+  BMI_Read(BMI_GYRO, BMI088_REG_GYRO_X_LSB, bmi088_rxbuf + 7, 6u);
+  return DEVICE_OK;
+}
+
+uint32_t BMI088_GyroWaitDmaCplt() {
+  return osThreadFlagsWait(SIGNAL_BMI088_GYRO_RAW_REDY, osFlagsWaitAll,
+                           osWaitForever);
+}
+
+int8_t BMI088_ParseAccl(BMI088_t *bmi088) {
+  if (bmi088 == NULL) return DEVICE_ERR_NULL;
+
+#if 1
+  int16_t raw_x, raw_y, raw_z;
+  memcpy(&raw_x, bmi088_rxbuf + 1, sizeof(raw_x));
+  memcpy(&raw_y, bmi088_rxbuf + 3, sizeof(raw_y));
+  memcpy(&raw_z, bmi088_rxbuf + 5, sizeof(raw_z));
+
+  bmi088->accl.x = (float)raw_x;
+  bmi088->accl.y = (float)raw_y;
+  bmi088->accl.z = (float)raw_z;
+
+#else
+  const int16_t *praw_x = (int16_t *)(bmi088_rxbuf + 1);
+  const int16_t *praw_y = (int16_t *)(bmi088_rxbuf + 3);
+  const int16_t *praw_z = (int16_t *)(bmi088_rxbuf + 5);
+
+  bmi088->accl.x = (float)*praw_x;
+  bmi088->accl.y = (float)*praw_y;
+  bmi088->accl.z = (float)*praw_z;
+
+#endif
+
+  /* 3G: 10920. 6G: 5460. 12G: 2730. 24G: 1365. */
+  bmi088->accl.x /= 5460.0f;
+  bmi088->accl.y /= 5460.0f;
+  bmi088->accl.z /= 5460.0f;
+
+  int16_t raw_temp =
+      (uint16_t)((bmi088_rxbuf[17] << 3) | (bmi088_rxbuf[18] >> 5));
+
+  if (raw_temp > 1023) raw_temp -= 2048;
+
+  bmi088->temp = (float)raw_temp * 0.125f + 23.0f;
+
+  return DEVICE_OK;
+}
+
+int8_t BMI088_ParseGyro(BMI088_t *bmi088) {
+  if (bmi088 == NULL) return DEVICE_ERR_NULL;
+
+#if 1
+  /* Gyroscope imu_raw -> degrees/sec -> radians/sec */
+  int16_t raw_x, raw_y, raw_z;
+  memcpy(&raw_x, bmi088_rxbuf + 7, sizeof(raw_x));
+  memcpy(&raw_y, bmi088_rxbuf + 9, sizeof(raw_y));
+  memcpy(&raw_z, bmi088_rxbuf + 11, sizeof(raw_z));
+
+  bmi088->gyro.x = (float)raw_x;
+  bmi088->gyro.y = (float)raw_y;
+  bmi088->gyro.z = (float)raw_z;
+
+#else
+  /* Gyroscope imu_raw -> degrees/sec -> radians/sec */
+  const int16_t *raw_x = (int16_t *)(bmi088_rxbuf + 7);
+  const int16_t *raw_y = (int16_t *)(bmi088_rxbuf + 9);
+  const int16_t *raw_z = (int16_t *)(bmi088_rxbuf + 11);
+
+  bmi088->gyro.x = (float)*raw_x;
+  bmi088->gyro.y = (float)*raw_y;
+  bmi088->gyro.z = (float)*raw_z;
+#endif
+
+  /* FS125: 262.144. FS250: 131.072. FS500: 65.536. FS1000: 32.768.
+   * FS2000: 16.384.*/
+  bmi088->gyro.x /= 32.768f;
+  bmi088->gyro.y /= 32.768f;
+  bmi088->gyro.z /= 32.768f;
+
+  bmi088->gyro.x *= M_DEG2RAD_MULT;
+  bmi088->gyro.y *= M_DEG2RAD_MULT;
+  bmi088->gyro.z *= M_DEG2RAD_MULT;
+
+  bmi088->gyro.x -= bmi088->cali->gyro_offset.x;
+  bmi088->gyro.y -= bmi088->cali->gyro_offset.y;
+  bmi088->gyro.z -= bmi088->cali->gyro_offset.z;
+
+  return DEVICE_ERR_NULL;
+}
+
+float BMI088_GetUpdateFreq(BMI088_t *bmi088) {
+  (void)bmi088;
+  return 400.0f;
+}

User/device/bmi088.h

@@ -0,0 +1,81 @@
+#pragma once
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/* Includes ----------------------------------------------------------------- */
+#include <stdbool.h>
+#include <stdint.h>
+
+#include "component/ahrs.h"
+#include "device/device.h"
+
+/* USER INCLUDE BEGIN */
+
+/* USER INCLUDE END */
+
+/* USER DEFINE BEGIN */
+
+/* USER DEFINE END */
+
+/* Exported constants ------------------------------------------------------- */
+/* Exported macro ----------------------------------------------------------- */
+/* Exported types ----------------------------------------------------------- */
+typedef struct {
+  struct {
+    float x;
+    float y;
+    float z;
+  } gyro_offset; /* 陀螺仪偏置 */
+} BMI088_Cali_t; /* BMI088校准数据 */
+
+typedef struct {
+  DEVICE_Header_t header;
+  AHRS_Accl_t accl;
+  AHRS_Gyro_t gyro;
+
+  float temp; /* 温度 */
+
+  const BMI088_Cali_t *cali;
+} BMI088_t;
+
+/* USER STRUCT BEGIN */
+
+/* USER STRUCT END */
+
+/* Exported functions prototypes -------------------------------------------- */
+int8_t BMI088_Init(BMI088_t *bmi088, const BMI088_Cali_t *cali);
+int8_t BMI088_Restart(void);
+
+bool BMI088_GyroStable(AHRS_Gyro_t *gyro);
+
+/* Sensor use right-handed coordinate system. */
+/*
+                x < R(logo)
+                        y
+                UP is z
+        All implementation should follow this rule.
+ */
+uint32_t BMI088_WaitNew();
+
+/*
+  BMI088的Accl和Gyro共用同一个DMA通道，所以一次只能读一个传感器。
+  即BMI088_AcclStartDmaRecv() 和 BMI088_AcclWaitDmaCplt() 中间不能
+  出现 BMI088_GyroStartDmaRecv()。
+*/
+int8_t BMI088_AcclStartDmaRecv();
+uint32_t BMI088_AcclWaitDmaCplt();
+int8_t BMI088_GyroStartDmaRecv();
+uint32_t BMI088_GyroWaitDmaCplt();
+int8_t BMI088_ParseAccl(BMI088_t *bmi088);
+int8_t BMI088_ParseGyro(BMI088_t *bmi088);
+float BMI088_GetUpdateFreq(BMI088_t *bmi088);
+
+/* USER FUNCTION BEGIN */
+
+/* USER FUNCTION END */
+
+#ifdef __cplusplus
+}
+#endif

User/device/device.h

@@ -23,6 +23,10 @@ extern "C" {
 
 /* AUTO GENERATED SIGNALS BEGIN */
 #define SIGNAL_DR16_RAW_REDY (1u << 0)
+#define SIGNAL_BMI088_ACCL_RAW_REDY (1u << 1)
+#define SIGNAL_BMI088_GYRO_RAW_REDY (1u << 2)
+#define SIGNAL_BMI088_ACCL_NEW_DATA (1u << 3)
+#define SIGNAL_BMI088_GYRO_NEW_DATA (1u << 4)
 /* AUTO GENERATED SIGNALS END */
 
 /* USER SIGNALS BEGIN */

User/device/device_config.yaml

@@ -1,3 +1,11 @@
+bmi088:
+  bsp_config:
+    BSP_GPIO_ACCL_CS: BSP_GPIO_ACCL_CS
+    BSP_GPIO_ACCL_INT: BSP_GPIO_ACCL_INT
+    BSP_GPIO_GYRO_CS: BSP_GPIO_GYRO_CS
+    BSP_GPIO_GYRO_INT: BSP_GPIO_GYRO_INT
+    BSP_SPI_BMI088: BSP_SPI_BMI088
+  enabled: true
 buzzer:
   bsp_config:
     BSP_PWM_BUZZER: BSP_PWM_TIM8_CH1

User/task/config.yaml

@@ -33,3 +33,10 @@
   function: Task_ctrl_gimbal
   name: ctrl_gimbal
   stack: 256
+- delay: 0
+  description: ''
+  freq_control: true
+  frequency: 500.0
+  function: Task_imu
+  name: imu
+  stack: 256

User/task/ctrl_gimbal.c

@@ -4,7 +4,6 @@
 */
 
 /* Includes ----------------------------------------------------------------- */
-#include "device/motor_rm.h"
 #include "task/user_task.h"
 /* USER INCLUDE BEGIN */
 #include "bsp/can.h"
@@ -75,9 +74,9 @@ void Task_ctrl_gimbal(void *argument) {
 
   uint32_t tick = osKernelGetTickCount(); /* 控制任务运行频率的计时 */
   /* USER CODE INIT BEGIN */
-  BSP_CAN_Init();
-  // MOTOR_DM_Register(&dm_4310_param);
 
+  /* USER CODE INIT END */
+  
   while (1) {
     tick += delay_tick; /* 计算下一个唤醒时刻 */
     /* USER CODE BEGIN */

User/task/imu.c

@@ -0,0 +1,44 @@
+/*
+    imu Task
+    
+*/
+
+/* Includes ----------------------------------------------------------------- */
+#include "task/user_task.h"
+/* USER INCLUDE BEGIN */
+
+/* USER INCLUDE END */
+
+/* Private typedef ---------------------------------------------------------- */
+/* Private define ----------------------------------------------------------- */
+/* Private macro ------------------------------------------------------------ */
+/* Private variables -------------------------------------------------------- */
+/* USER STRUCT BEGIN */
+
+/* USER STRUCT END */
+
+/* Private function --------------------------------------------------------- */
+/* Exported functions ------------------------------------------------------- */
+void Task_imu(void *argument) {
+  (void)argument; /* 未使用argument，消除警告 */
+
+  
+  /* 计算任务运行到指定频率需要等待的tick数 */
+  const uint32_t delay_tick = osKernelGetTickFreq() / IMU_FREQ;
+
+  osDelay(IMU_INIT_DELAY); /* 延时一段时间再开启任务 */
+
+  uint32_t tick = osKernelGetTickCount(); /* 控制任务运行频率的计时 */
+  /* USER CODE INIT BEGIN */
+
+  /* USER CODE INIT END */
+  
+  while (1) {
+    tick += delay_tick; /* 计算下一个唤醒时刻 */
+    /* USER CODE BEGIN */
+
+    /* USER CODE END */
+    osDelayUntil(tick); /* 运行结束，等待下一次唤醒 */
+  }
+  
+}

User/task/init.c

@@ -37,6 +37,7 @@ void Task_Init(void *argument) {
   task_runtime.thread.atti_esti = osThreadNew(Task_atti_esti, NULL, &attr_atti_esti);
   task_runtime.thread.ctrl_chassis = osThreadNew(Task_ctrl_chassis, NULL, &attr_ctrl_chassis);
   task_runtime.thread.ctrl_gimbal = osThreadNew(Task_ctrl_gimbal, NULL, &attr_ctrl_gimbal);
+  task_runtime.thread.imu = osThreadNew(Task_imu, NULL, &attr_imu);
 
   // 创建消息队列
   /* USER MESSAGE BEGIN */

User/task/user_task.c

@@ -33,4 +33,9 @@ const osThreadAttr_t attr_ctrl_gimbal = {
     .name = "ctrl_gimbal",
     .priority = osPriorityNormal,
     .stack_size = 256 * 4,
+};
+const osThreadAttr_t attr_imu = {
+    .name = "imu",
+    .priority = osPriorityNormal,
+    .stack_size = 256 * 4,
 };

User/task/user_task.h

@@ -18,6 +18,7 @@ extern "C" {
 #define ATTI_ESTI_FREQ (1000.0)
 #define CTRL_CHASSIS_FREQ (500.0)
 #define CTRL_GIMBAL_FREQ (500.0)
+#define IMU_FREQ (500.0)
 
 /* 任务初始化延时ms */
 #define TASK_INIT_DELAY (100u)
@@ -26,6 +27,7 @@ extern "C" {
 #define ATTI_ESTI_INIT_DELAY (0)
 #define CTRL_CHASSIS_INIT_DELAY (500)
 #define CTRL_GIMBAL_INIT_DELAY (0)
+#define IMU_INIT_DELAY (0)
 
 /* Exported defines --------------------------------------------------------- */
 /* Exported macro ----------------------------------------------------------- */
@@ -40,6 +42,7 @@ typedef struct {
         osThreadId_t atti_esti;
         osThreadId_t ctrl_chassis;
         osThreadId_t ctrl_gimbal;
+        osThreadId_t imu;
     } thread;
 
     /* USER MESSAGE BEGIN */
@@ -70,6 +73,7 @@ typedef struct {
         UBaseType_t atti_esti;
         UBaseType_t ctrl_chassis;
         UBaseType_t ctrl_gimbal;
+        UBaseType_t imu;
     } stack_water_mark;
 
     /* 各任务运行频率 */
@@ -79,6 +83,7 @@ typedef struct {
         float atti_esti;
         float ctrl_chassis;
         float ctrl_gimbal;
+        float imu;
     } freq;
 
     /* 任务最近运行时间 */
@@ -88,6 +93,7 @@ typedef struct {
         float atti_esti;
         float ctrl_chassis;
         float ctrl_gimbal;
+        float imu;
     } last_up_time;
 
 } Task_Runtime_t;
@@ -102,6 +108,7 @@ extern const osThreadAttr_t attr_rc;
 extern const osThreadAttr_t attr_atti_esti;
 extern const osThreadAttr_t attr_ctrl_chassis;
 extern const osThreadAttr_t attr_ctrl_gimbal;
+extern const osThreadAttr_t attr_imu;
 
 /* 任务函数声明 */
 void Task_Init(void *argument);
@@ -110,6 +117,7 @@ void Task_rc(void *argument);
 void Task_atti_esti(void *argument);
 void Task_ctrl_chassis(void *argument);
 void Task_ctrl_gimbal(void *argument);
+void Task_imu(void *argument);
 
 #ifdef __cplusplus
 }