Files
Simba-OmniInfantry/底盘
LSMushui 3e5e5e3f95 fix(bmi088): 数据路停摆的自恢复(任务上下文健康检查)
现场遥测(zo/ck 字段生效,说明新固件在跑):
  yaw -18.13 -> -18.61 / 0.7s , pitch/roll/an 全部纹丝不动
  ca=832 cg=1032 —— **8 行完全一致,采样计数停止增长**
  zo=-0.0009 ck=1 (零偏标定正常) , gx/gy/gz 也恒定

## 判定
ca/cg 不增长 = SPI 完成回调不再产生样本,IMU 数据已冻结在最后一个样本上。
此时 yaw 的"匀速自漂"只是 EKF 在忠实积分冻结值:
  gz - zo = -0.0117 - (-0.0009) = -0.0108 rad/s ≈ 观测 -0.0119 rad/s
所以姿态算法本身是对的,问题全在数据路。上一轮加的 z 标定健壮性生效了
(zo 从 0.067 降到 0.0009,ck=1),但数据路仍会停摆。

## 为什么必须放在任务上下文
停摆只有两类原因,而**中断回调里的兜底两类都救不了**:
  a) hspi1 卡在 BUSY(某次 SPI/DMA 出错后 HAL 没回到 READY):
     start_dma_read() 的 HAL_SPI_GetState 检查让每次调用都直接返回;
  b) BMI088 的 DRDY 是电平型信号:某次失败/被挡掉的读没把传感器的数据
     寄存器读走,INT 电平就保持住,之后既无下降沿也无上升沿 ——
     EXTI 永不触发,写在 EXTI 回调里的任何兜底都不会执行。
故新增 bmi088_health_check(),由 attitude_update() 每 1ms 调用:采样计数
超过 BMI088_STALL_MS(5ms)没增长即判停摆,执行
  关 EXTI -> 复位 read_phase/片选 -> SPI 卡住则 abort,仍不 READY 就
  DeInit+Init(hspi1.Init 里仍是模式3/16分频,不会被改回)
  -> 清 EXTI 挂起标志 -> 阻塞读一次加速度+陀螺(顺带清传感器 DRDY 电平)
  -> 重新使能 EXTI
若中断路始终修不好,则退化为每 5ms 补读一次(约 200Hz)的轮询保底。因为
dt 固定 1ms、1kHz 调用,1 秒内积分出的总转角仍然正确(保持值×0.001×1000),
只是运动解析粒度变粗 —— 用于排障足够,正式使用应查清停摆根源。

## 附带
- 实现 HAL_SPI_ErrorCallback(HAL 里是 __weak):此前完全没实现,SPI/DMA
  出错后相位与片选无人复位;现在复位相位/片选并累加 bmi088_spi_errors。
- 新增 bmi088_spi_state() 暴露 HAL_SPI_GetState,debug_task 追加
  se=<SPI错误数> st=<SPI状态,1=READY>。若 st 长期非 1 即命中原因 (a);
  若 st 恒为 1 而 ca/cg 不涨,即命中原因 (b)。
- 已静态核对 DMA 流分配无冲突:SPI1 RX/TX = DMA2_Stream2/3 ch3,
  USART1 = Stream5/7, USART6 = Stream1/6, USART3_RX = DMA1_S1,
  I2C2_TX = DMA1_S7,互不重叠。

两个工程同步修改,内容一致。
2026-09-12 11:32:42 +08:00
..

Simba-ELCT-FrameWork

Simba-git ELEC

Author language license

简介

Simba自己的C板电控框架!

本项目的计划是基于 DJI C型开发板 的基础上打造一个更适合Simba同学们的代码框架

本框架致力于实现不同类型的机器人的代码通用化,只需要选择底盘云台的类型,修改一下对应物理参数即可实现对机器人的适配

配套套件

上位机,ROS接口待开发

模块支持

详细信息请参考 Simba-ELCT-FrameWork文档

主要模块

  • Robot cmd
    机器人控制模块:
    • 大疆电机
    • 达妙电机
    • 瓴控电机
    • 小米电机
    • 超级电容控制板
    • 板间通信(CAN)
    • PWM 控制舵机
    • PWM 控制气泵
  • Chassis
    底盘模块:
    • 麦轮底盘
    • 全向轮底盘
    • 舵轮底盘
    • 平衡底盘
  • Gimbal
    云台模块:
    • yaw-pitch 直连云台
    • yaw直连-pitch丝杆 云台
    • yaw-pitch 丝杆云台
  • Shoot
    发射机构模块:
    • 摩擦轮+拨弹盘
    • 摩擦轮+弹鼓+推杆
  • Communication
    通信模块:
    • 板间通信(CAN2)
    • 上下位机通信
  • Music
    音乐模块:
    • 开机声
    • 报错音
    • 裁判系统接入提示音
    • 《卡农》
    • 《天空之城》
    • 《恭喜发财》
    • 《好运来》
    • 《See You Again》
    • 《Unity》
    • 《你》

开发工具

本项目使用HAL库编写,通过CubeMX生成项目,使用FreeRTOS

使用VSCode作为代码编辑器,Keil5作为IDE

Keil5编译器使用AC6版本

虽然keil5老,但在嵌入式调试以及环境配置方面是非常简单易上手的。千万不要用keil5来编辑代码!!!

VSCode作为现代化代码编辑器 ,通过各种插件即可实现各种提高效率的开发方式,尤其是Github Copilot

AC6编译器相比古早AC5编译器效率更高,AC5编译空项目就要足足1min47s,非常不中,相比之下AC6只需要6s,遥遥领先

但是CubeMX开启FreeRTOS无法直接使用AC6编译器
强烈建议通过此教程(From COD战队GrassFan Wang)配置好自己的环境

欢迎贡献

如果你发现了本项目中的问题和可优化的点,可用创建issue进行讨论

并且fork本项目后提交pr来贡献你的代码

我们的管理员审核后会将你的代码合并进来

贡献代码时请参照 注意事项 中的贡献代码部分。

编写代码时参考API

开发日志

LOG.md 记录了大家在开发过程中的各种奇思妙想和经验。多翻一翻或许能发现惊喜哦。大家有什么想法也都可以往里面写

API.md 为开发过程中所使用的模块接口标准,若在编写代码时发现代码与标准冲突,基于本标准修改代码

后续计划

具体要做的事情在TODO中

致谢

感谢各个战队的代码开源,所有本框架涉及到的主要的参考资料位于reference.md

附录

本文的详细补充内容写在 附录 中

如发现本项目中的问题,请添加至问题列表并与相关负责人联系,如果有解决方案可以提交pull request

通讯信息

  • 作者 连山木水 微信:18088745066 QQ:1194309310