 LSMushui
|
e3d432f3b5
|
refactor(modules): 按角色重排 modules/ 目录,消除命名不一致
原 modules/ 下目录大小写混用(BMI088/BUZZER/DR16/IST8310/LED/PID 为大写,
attitude/c_comm/filter/gimbal/ins/motor/referee/shoot 为小写),且把第三方
移植代码(QuaternionEKF/kalman_filter)与本工程封装(ins)混在同一目录。
新结构(全部小写,按角色分层,第三方代码单独隔离):
modules/
algorithm/ pid.c/h filter.c/h 通用算法
imu/ attitude.c/h ins.c/h 姿态与惯导封装
imu/qekf/ QuaternionEKF.c/h kalman_filter.c/h
(移植自 Wang Hongxi INS 例程)
sensor/ bmi088.c/h ist8310.c/h 板载传感器驱动
comms/ dr16.c/h c_comm.c/h referee.c/h
motor/ dji_motor.c/h 电机抽象
control/ gimbal.c/h shoot.c/h 整车控制逻辑
(底盘为 chassis.c/h)
dev/ led.c/h buzzer.c/h 板级指示/发声
共移动 58 个文件(每板 29 个),旧目录全部删除。
工程文件同步(每个工程各 2 个):
- .uvprojx: Modules 分组 16 个 <FilePath> 改为新路径;
2 个非空 <IncludePath> 元素:15 个旧模块路径收敛为 8 个新目录,
并顺带删除陈旧项 ../modules/AHRS(目录根本不存在,legacy 时代残留)
与冗余项 ..\bsp(与 ../Bsp/Inc 重复)
- .uvoptx: 16 个 <PathWithFileName> 同步
关于"为什么不用改源码": Keil 的 include 靠 IncludePath 解析,本工程所有
#include 都是纯文件名形式(无路径限定),所以移动目录只需改工程配置。
另外 .h 完全不登记在工程里(只有 16 个 .c 被登记),故头文件只需移动。
回归验证(无法在此环境编译,用等价判据):
- 两个工程引用的 98 / 95 个 <FilePath> 全部真实存在
- 磁盘上 47 / 45 个 .c 全部仍被工程引用 —— 即没有任何文件掉出编译
- 2 个 IncludePath 元素均含全部 8 个新模块目录,无旧路径残留
- 所有 IncludePath 指向的目录均真实存在
- .uvprojx/.uvoptx XML 良构
- 两棵树结构一致(chassis/gimbal 等板级差异符合预期)
⚠️ 仍需在 Keil 里点一次编译确认(见 README 的构建章节)。
|
2026-09-12 11:51:41 +08:00 |
|
|
LSMushui
|
3e1bae6b98
|
chore: 同步 Keil/VSCode 本地状态(非本次代码改动)
- 底盘 .uvoptx: DSP Library 分组展开状态 tvExp 0 -> 1(Keil 中展开工程树
所致,不影响编译)
- 云台 .vscode/settings.json: K230 Pylance stub 路径随工具链更新
两处均为工具自动写入,一并入库以保持工作区干净。
|
2026-09-12 11:15:24 +08:00 |
|
|
LSMushui
|
4f18ada2f7
|
fix(ins): 修复 QEKF 矩阵内存分配失败(堆 512B -> 8KB),并恢复姿态诊断位
## 根因: 堆太小导致卡尔曼滤波静默失效
modules/ins/kalman_filter.h 的分配宏是
#ifdef _CMSIS_OS_H
#define user_malloc pvPortMalloc
#else
#define user_malloc malloc
#endif
而 kalman_filter.c 整个编译单元只 include 了 kalman_filter.h,从未引入
cmsis_os.h,因此 _CMSIS_OS_H 未定义 -> user_malloc 展开为 libc malloc,
FreeRTOS 那 32KB(configTOTAL_HEAP_SIZE=32768)堆完全用不上。
libc malloc 的堆来自 MDK-ARM/startup_stm32f407xx.s 的 Heap_Size,CubeMX
默认值是 0x200 = 512 字节。而 Kalman_Filter_Init(6, 0, 3) 会发起 25 次
分配、合计约 1602 字节(P/Pminus/F/FT/Q/S/temp_matrix/temp_matrix1 各
144B,H/HT/K 各 72B,R 36B,Q 系列 24B 等),且全程没有一处 NULL 检查,
分配失败后紧接着 memset(NULL, 0, n) 并把 NULL 直接交给 arm_mat_* 使用:
- 前半段小分配成功、后半段 144B 级分配返回 NULL
- arm_mat_* 对 pData=NULL 只读写地址 0 附近,函数本身不报错、只是不改
动输出 -> 滤波器不再更新状态,但 QEKF_INS.UpdateCount 照常自增
- 表现为: att_ready=1(看起来"在跑")、欧拉角却恒定不动
对照原始例程(能正常工作的那版)RoboMaster-C-Board-INS-Example-master,
其 MDK-ARM/startup_stm32f407xx.s 的 Heap_Size 为 0x2000 = 8KB,是本工程
的 16 倍。本次将两个工程的 Heap_Size 一并提到 0x2000,与该例程一致。
注意: startup_stm32f407xx.s 由 CubeMX 生成,若日后重新生成工程,这行会
被改回 0x200,需再次修改(或改走 pvPortMalloc 路线)。注释用纯 ASCII,
避免 armasm 处理非 ASCII 源文件。
## 恢复姿态诊断位
上一版 debug_task.c 把 cvg 换成了 att_ready,丢掉了唯一的"是否真的收敛"
判据 —— 于是"IMU 没数据"和"滤波器没跑"都表现为 cvg=1 + 三个 0.00,无法
区分。本次:
- cvg 恢复为 INS.ConvergeFlag(与原诊断输出同义)
- 新增 rdy(=att_ready)、imu(=bmi088_online)、an(=|accel|)、
gn(=|gyro|) 四个姿态链路健康位
- 保留 DEBUG_ATT_HEALTH 开关,置 0 即只输出三个欧拉角
- 文件头补注: yaw 无绝对基准,上电静止时恒为 0,不能作为故障判据
|
2026-09-12 11:15:16 +08:00 |
|
|
LSMushui
|
944d0201da
|
chore(mdk): 对齐 uvoptx 的文件编号,消除删除条目留下的空档
删除 bsp_uart 的两个文件条目后,.uvoptx 的 <FileNumber> 序列在删除点后面
留下断号(云台 1..97 后直接跳到 100,底盘 1..94 后跳到 97)。Keil 重新保存
工程时会自行把末项改回连续编号(底盘已被 Keil 规范为 95),此处把云台
一并规范为 98,使两个工程的编号均为 1..N 连续。
仅改编号数值,无文件增删,不影响编译。
|
2026-09-12 11:03:44 +08:00 |
|
|
LSMushui
|
a9d3d97ed8
|
refactor(bsp): 删除无实际作用的 bsp_uart 模块
分析结论: Bsp 层并存 bsp_uart.{c,h} 与 bsp_usart.{c,h} 两套串口支持包,
其中 bsp_uart 是死代码,证据:
1. bsp_uart 只导出一个函数 UartSendTxMessage()(HAL_UART_Transmit 阻塞
发送 + 最多 5 次重发),全工程检索无任何调用方;
2. #include "bsp_uart.h" 只出现在 bsp_uart.c 自身,Application/Core 层
一律包含 bsp_usart.h;
3. bsp_uart.h 里的 UART1/UART2 宏也无人使用,仅被 bsp_usart.c 的注释提及;
4. 真正在用的是 bsp_usart.{c,h}(USART1/3/6 的 DMA 循环接收 + 空闲中断整帧
回调 + TX DMA),main.c/stm32f4xx_it.c/referee_task/can_task 均依赖它。
变更:
- 删除 云台/底盘 各自的 Bsp/Src/bsp_uart.c 与 Bsp/Inc/bsp_uart.h;
- 从两个 Keil 工程的 .uvprojx(编译文件列表)与 .uvoptx(文件选项)中摘除
对应条目,工程文件良构性已校验通过。
注: bsp_usart.c 中 usart1_tx_dma_enable()/usart6_tx_dma_enable() 目前也
无调用方(仅 usart1_tx_dma_init() 被 can_task 调用,为视觉自瞄预留),属接口
预留而非死模块,本次保留。
|
2026-09-12 10:33:20 +08:00 |
|
|
LSMushui
|
a4da5ad17c
|
chore: 导入 Simba-OmniInfantry 基线(云台/底盘双工程)
- 云台(ROBOT_TYPE_GIMBAL)与底盘(ROBOT_TYPE_CHASSIS)完整固件源码
- 新增根级 .gitignore,排除 Keil MDK-ARM 构建产物(.o/.d/.crf/.axf/.lnp/.map/.htm/.sct/.dep/.iex/.lst 等)
与 *.uvguix.* / DebugConfig/(与机器绑定的 UI 布局)
- core.autocrlf=false,避免固件源码在检出时被改动换行符
|
2026-09-12 10:28:21 +08:00 |
|