| 项目 | 说明 |
|---|---|
| 项目名称 | D24Ademo — 基于霍尔编码器的四轮电机控制系统 |
| 平台 | WHEELTEC D24A 四轮底盘 |
| MCU | STM32F103(中等容量,Flash 256KB / RAM 48KB) |
| 固件库 | STM32F10x Standard Peripheral Library V3.5.0 |
| IDE | Keil MDK (工程文件: USER/Tb6612demo.uvprojx) |
| 目标 | 最终实现倒立摆自平衡控制 |
| 当前阶段 | 四轮 PI 速度闭环控制 + LCD 调试显示 |
| GitHub | https://github.com/WuWingKit/Inverted-pendulum |
| 电机 | 方向引脚 | PWM 通道 | 定时器 |
|---|---|---|---|
| A | PC13 (AIN1), PC14 (AIN2) | PA0 — TIM5_CH1 | TIM5 |
| B | PB12 (BIN1), PB13 (BIN2) | PA1 — TIM5_CH2 | TIM5 |
| C | PB0 (CIN1), PB1 (CIN2) | PA2 — TIM5_CH3 | TIM5 |
| D | PC1 (DIN1), PC2 (DIN2) | PA3 — TIM5_CH4 | TIM5 |
- PWM 频率:
72MHz / (7199+1) / (0+1) = 10kHz - 占空比范围:0 ~ 7200
| 电机 | 编码器接口 | 引脚 | 模式 |
|---|---|---|---|
| A | TIM8 硬件编码器 | PC6 (A相), PC7 (B相) | 硬件正交解码 |
| B | TIM2 硬件编码器 | PA15 (A相), PB3 (B相) | 硬件正交解码(完全重映射,禁用 SWJ) |
| C | TIM3 硬件编码器 | PA6 (A相), PA7 (B相) | 硬件正交解码 |
| D | 软件编码器 | PB14 (A相), PB15 (B相) | 软件轮询正交解码 |
⚠️ 注意: TIM2 使用了完全重映射(GPIO_FullRemap_TIM2),并禁用了 SWJ 调试接口(GPIO_Remap_SWJ_Disable)。这意味着 PA15 和 PB3 被用作编码器输入,烧录时可能需要按住复位键或使用串口 ISP 下载。如果调试或下载遇到问题,这是首先要检查的地方。
| 外设 | 引脚 | 说明 |
|---|---|---|
| ADC 电池检测 | PA5 (ADC1_CH5) | 10 次采样平均,Vbat = ADC值 × 3.3 × 11 / 4096 |
| USART 调试串口 | PA9 (TX), PA10 (RX) | 波特率 115200 |
| LCD | SPI 接口(具体引脚见 lcd_init.c) | 1.44 寸 128×128 彩色 LCD |
main.c
├── SystemInit() — 系统时钟初始化 (72MHz)
├── delay_init() — 滴答定时器延时
├── Gpio_Init() — 电机方向引脚初始化
├── uart_init(115200) — 串口调试输出
├── adc_Init() — ADC 电池电压检测
├── PWM_Int(7199, 0) — 四路 PWM 初始化 (TIM5, 10kHz)
├── Encoder_Init_Tim8() — 硬件编码器 A (TIM8)
├── Encoder_Init_Tim2() — 硬件编码器 B (TIM2, 完全重映射)
├── Encoder_Init_Tim3() — 硬件编码器 C (TIM3)
├── Encoder_Init_Soft() — 软件编码器 D (PB14/PB15)
├── LCD_Init() — LCD 初始化
│
└── while(1) 主循环 (50ms) ────
├── Get_adc_Average() — 读取电池电压
├── Encoder_Soft_Poll() — 轮询软件编码器 D
├── Read_Encoder() — 读取四个编码器速度值
├── Velocity_A/B/C/D() — PI 速度闭环计算
├── Set_PWM() — 更新四路 PWM 占空比
├── LCD_Show_Debug() — LCD 显示调试信息
└── printf() — 串口输出调试信息
D24Ademo/
├── CORE/ — CMSIS 核心文件
│ ├── core_cm3.c/h — Cortex-M3 内核接口
│ └── startup_stm32f10x_md.s — 启动文件(中等容量)
├── HAREWER/ — 硬件驱动层
│ ├── ADC/adc.c/h — ADC 电池电压采样
│ ├── ENCODER/encoder.c/h — 编码器(3路硬件 + 1路软件正交解码)
│ ├── GPIO/gpio.c/h — 电机方向引脚初始化
│ ├── LCD/ — 1.44寸 LCD 驱动
│ │ ├── lcd.c/h — LCD 底层操作
│ │ ├── lcd_init.c/h — LCD 初始化
│ │ └── lcdfont.h — 字库
│ ├── MOTO/moto.c/h — 电机方向控制 + PI 速度闭环
│ └── PWM/pwm.c/h — TIM5 四路 PWM 输出
├── STM32F10x_FWLIB/ — STM32F10x 标准外设库 V3.5.0
│ ├── inc/ — 头文件
│ └── src/ — 源文件
├── SYSTEM/ — 系统层
│ ├── delay/delay.c/h — 延时函数
│ ├── sys/sys.c/h — 系统初始化
│ └── usart/usart.c/h — 串口驱动
├── USER/ — 应用层
│ ├── main.c — 主程序
│ ├── stm32f10x.h — 芯片头文件
│ ├── stm32f10x_conf.h — 外设库配置文件
│ ├── stm32f10x_it.c/h — 中断服务函数
│ ├── system_stm32f10x.c/h — 系统时钟配置
│ └── Tb6612demo.uvprojx — Keil 工程文件
├── OBJ/ — 链接脚本
│ └── Minibalance.sct — 散列加载文件
├── .gitignore — Git 忽略配置
├── CONTRIBUTING.md — 团队协作指南
├── DEVLOG.md — 本文件(开发日志)
└── keilkill.bat — Keil 编译产物清理脚本
| 功能 | 状态 | 说明 |
|---|---|---|
| 系统时钟 72MHz | ✅ | 标准 HSE 8MHz × 9 PLL |
| GPIO 初始化 | ✅ | PB0/1/12/13, PC1/2/13/14 推挽输出 |
| PWM 输出 | ✅ | TIM5 四路 PWM,频率 10kHz,占空比 0~7200 |
| 编码器 A (TIM8) | ✅ | 硬件正交解码, PC6/PC7 |
| 编码器 B (TIM2) | ✅ | 硬件正交解码, 完全重映射 PA15/PB3 |
| 编码器 C (TIM3) | ✅ | 硬件正交解码, PA6/PA7 |
| 编码器 D (软件) | ✅ | 软件正交解码, PB14/PB15 轮询 |
| ADC 电压检测 | ✅ | PA5, 10次平均, 分压比 11:1 |
| PI 速度闭环 | ✅ | 增量式 PI, Kp=1.0, Ki=3.0, Kd=0 |
| LCD 调试显示 | ✅ | 显示四路速度/PWM、目标速度、电压、PID参数 |
| 串口调试输出 | ✅ | 115200bps, printf 输出实时数据 |
| Git 版本管理 | ✅ | 已配置 .gitignore,推送到 GitHub |
| 功能 | 优先级 | 说明 |
|---|---|---|
| MPU6050 陀螺仪驱动 | 🔴 高 | 获取倾角/角速度,倒立摆核心传感器 |
| I2C 通信驱动 | 🔴 高 | MPU6050 依赖 I2C 接口 |
| 直立平衡 PID | 🔴 高 | 角度环 + 角速度环,倒立摆核心算法 |
| 速度环 PID | 🟡 中 | 位置控制,实现定点自平衡 |
| 转向控制 | 🟡 中 | 差速转向,实现遥控/自主导航 |
| 蓝牙/无线调试 | 🟢 低 | 远程调参,方便调试 |
| 上位机调参工具 | 🟢 低 | 实时观察数据曲线,在线调整 PID |
问题现象: LCD 上 A/B 电机编码器读数正常,C/D 显示 0 或 -1 代码排查结论: TIM3 硬件编码器和 D 电机软件编码器初始化代码均无逻辑错误,怀疑硬件连接问题
| 编码器 | 代码中使用 | 确认事项 |
|---|---|---|
| C 电机 | PA6 (A相), PA7 (B相) | 万用表蜂鸣档:编码器 C 接口 A/B 线是否连通到 MCU PA6/PA7? |
| D 电机 | PB10 (A相), PB11 (B相) | 万用表蜂鸣档:编码器 D 接口 A/B 线是否连通到 MCU PB10/PB11? |
⚠️ 关键怀疑点: 同事将 D 编码器从 PB14/PB15 改为 PB10/PB11 是基于"PB14 被 E3B 占用"的逻辑判断,但需要实际确认 PCB 上 PB10/PB11 是否有走线连接到 D 编码器接口。
转动 C/D 电机,用示波器测量编码器信号引脚,应看到正交方波:
A相: ▔▔__▔▔__▔▔__▔▔__
B相: __▔▔__▔▔__▔▔__▔▔ (相位差90°)
- 如果有波形但读数为 0 → 代码配置问题(TIM3 时钟、引脚复用冲突等)
- 如果无波形(恒定高/低电平) → 硬件连接问题(线序错误、虚焊、引脚不对应)
在 main.c 的 while 循环中临时加入以下代码,通过串口查看原始引脚电平:
// 临时诊断代码 - 读取 C/D 编码器原始引脚电平
u8 pa6 = GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_6);
u8 pa7 = GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_7);
u8 pb10 = GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_10);
u8 pb11 = GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_11);
printf("RAW: PA6=%d PA7=%d PB10=%d PB11=%d\r\n", pa6, pa7, pb10, pb11);转动电机时,4 个值应该快速跳变。如果某引脚始终为 0 或 1 不变 → 该引脚无编码器信号。
| 引脚 | 默认复用功能 | 与当前用途是否冲突 |
|---|---|---|
| PA6 | SPI1_MISO, TIM3_CH1, ADC_IN6 | ✅ 无冲突(SPI1 未初始化,TIM3_CH1 正是编码器用途) |
| PA7 | SPI1_MOSI, TIM3_CH2, ADC_IN7 | ✅ 无冲突 |
| PB10 | I2C2_SCL, USART3_TX, TIM2_CH3(remap后) | |
| PB11 | I2C2_SDA, USART3_RX, TIM2_CH4(remap后) |
如果确认 PB10/PB11 有编码器信号但软件读数异常,可尝试临时禁用 TIM2 完全重映射(注释
GPIO_FullRemap_TIM2那行),看 D 编码器读数是否恢复,以此判断 TIM2 remap 是否干扰了 PB10/PB11 的 GPIO 输入。
- 文件:
HAREWER/ENCODER/encoder.c - 问题:
Encoder_Init_Tim4()函数已实现(PB6/PB7),但main.c中并未调用 - 现状: 电机 D 使用软件编码器(PB14/PB15)代替
- 建议: 如果软件编码器性能足够,可删除 TIM4 相关代码以减小代码体积;如果需要更高精度,可改回 TIM4 硬件编码器
- 文件:
HAREWER/ENCODER/encoder.c:97 - 问题: TIM2 完全重映射后调用了
GPIO_Remap_SWJ_Disable,禁用了 JTAG/SWD - 影响: 无法使用 ST-Link/J-Link 正常调试和下载
- 临时方案: 烧录时按住复位键,点击下载后松开;或使用串口 ISP 下载
- 根本修复: 如果不需要使用 PB3,可仅重映射部分引脚而非完全禁用 SWJ
- 文件:
HAREWER/MOTO/moto.c - 问题:
Velocity_A/B/C/D()四个函数逻辑完全相同,仅函数名不同 - 建议: 重构为单函数 + 传参,或使用结构体数组管理
- 文件:
HAREWER/MOTO/moto.h:6 - 问题:
extern float Velcity_Kd;声明了微分系数但 PI 控制中未使用 - 建议: 保留,后续升级为 PID 时会用到
- 改动者: WuWingKit
- 类型: Bug 修复 / 控制策略调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,USER/main.c,DEVLOG.md - 内容:
- 通过多代理代码审查确认,小角度越调越偏的关键风险不是单个 PID 参数,而是运行中零偏学习、hold 区清位置、漂移限幅仍同向输出等机制叠加,容易让小角度误差被吃掉并形成单方向速度累积。
- 新增
BALANCE_AUTO_BIAS_ENABLE = 0,默认禁用运行中的自动角度 Bias 学习,避免把真实小角度倾斜逐步学成零点;零点仍通过 KEY2/串口调零设置。 - 修改 hold 区逻辑:只有未漂移时才允许极小角度静止输出 0,并且不再清零
Balance_Position,避免慢速漂移时位置回中信息被反复抹掉。 - 修改漂移回拉逻辑:当小车已经漂移且角度仍小于
BALANCE_DRIFT_RECENTER_ANGLE_X100时,如果当前输出仍会把车推得更远,则强制给BALANCE_DRIFT_PULL_PWM的反向回拉输出,而不是仅限幅同方向输出。 - 串口输出增加
Pos字段,方便观察Balance_Position是否还在单方向累积,验证漂移回拉是否真实生效。
- 验证: 待重新编译烧录。重点观察小角度时
Pos是否不再被清零且能够被拉回;若SF/Pos仍与 PWM 同向加速,需要继续排查编码器速度符号。
- 改动者: WuWingKit
- 类型: 参数调整 / 电机输出补偿
- 改动文件:
HAREWER/PWM/pwm.c,DEVLOG.md - 内容:
- 根据实车调试需求,将
MOTOR_PWM_DEADZONE从1100下调到900。 - 保留
MOTOR_PWM_CMD_FLOOR = 120和MOTOR_PWM_DEADZONE_RAMP = 900的渐进补偿逻辑,小命令仍会从 0 平滑过渡到完整死区补偿。 - 目标是降低小角度附近和脉冲恢复阶段的输出突兀感,减少电机补偿过强导致的抖动或过冲。
- 根据实车调试需求,将
- 验证: 待重新编译烧录。重点观察小角度微调是否更柔和;若电机又出现“想动但不动”,可回调到
1000。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 防倒策略
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“如果往一个方向一直偏移,希望突然增加一个急加速把杆子晃到另一边,然后再慢一点减速把速度控回来”,新增漂移脉冲状态机。
- 当小车处于漂移状态、摆杆继续远离零点、角度超过约
1.8°且车速已明显累积时,触发BALANCE_KICK_PWM = 5200的短促急加速脉冲。 - 脉冲持续
BALANCE_KICK_TICKS = 18个控制周期,当前2ms周期下约36ms,用于快速给杆子一个足够大的反向摆动趋势。 - 脉冲结束后进入
BALANCE_RECOVER_TICKS = 90的慢恢复阶段,使用BALANCE_RECOVER_SPEED_KP = 0.70,避免立即猛刹导致杆子又被减速加速度拉回同一侧。 - 新增
BALANCE_KICK_COOLDOWN_TICKS = 120冷却时间,避免连续脉冲造成抽动;漂移限幅不作用于脉冲期间,保证急加速真实生效。
- 验证: 待重新编译烧录。重点观察单方向漂移时是否会出现短促急加速,并在之后较慢减速;若脉冲过猛,可降低
BALANCE_KICK_PWM或BALANCE_KICK_TICKS。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 防漂移
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“中间晃住稳定的时间变久了,但仍会晃着晃着往某个方向跑”,在防倒优先策略上增加更明确的漂移回拉。
- 新增
Balance_Drift_Position_Kp = 0.012,漂移状态下使用更强的位置回拉;正常状态仍使用Balance_Position_Kp = 0.005,避免过度影响中间晃动。 - 将
BALANCE_DRIFT_POSITION从12000降到7000,更早识别小车已经开始离开中心区域。 - 新增
BALANCE_DRIFT_PUSH_LIMIT = 900,漂移状态下如果输出方向仍然会把小车推向更远位置,则限制该方向输出;反向回拉输出不限制。 - 目标是在允许杆子持续摆动的前提下,避免小车越晃越远,保留速度余量用于下一次救杆。
- 验证: 待重新编译烧录。重点观察小车是否会在跑远后主动往回拉,而不是只减慢单方向漂移。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 防倒策略
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据新目标“不要求杆子最后稳定立着,允许一直晃动,但不能倒下,也不能让小车往一个方向持续缓慢加速”,将策略从静稳优先改为防倒优先。
- 新增
drifting状态:当车速Balance_Speed_Filter超过BALANCE_DRIFT_SPEED或位置Balance_Position超过BALANCE_DRIFT_POSITION时,认为小车正在单方向耗尽速度余量。 - 将
BALANCE_DRIFT_SPEED从900降到600,新增BALANCE_DRIFT_POSITION = 12000,更早识别小车单向漂移。 - 将漂移状态下速度阻尼强制提高到
Balance_Return_Speed_Kp = 2.20,位置回中提高到Balance_Position_Kp = 0.005,让小车优先泄掉单方向速度。 - 漂移状态下禁用最小输出保底和救杆最小输出保底,避免小车已经跑偏时仍被强制继续向同方向加速。
- 保留角度 PD 与救杆补偿,允许杆子来回摆动,但不再放任小车持续往一个方向加速到没有速度余量。
- 验证: 待重新编译烧录。重点观察
SF和小车位移是否不再持续单方向增大;杆子来回摆动可接受,只要不倒下且速度能周期性释放。
- 改动者: WuWingKit
- 类型: Bug 修复 / 编译警告修复
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 修复 Keil ARMCC 警告
#39-D: division by zero,原因是BALANCE_RESCUE_ANGLE_X100与BALANCE_FALL_START_X100同为120,导致救杆最小输出插值分母为 0。 - 将
BALANCE_FALL_START_X100从120调整为80,约0.8°开始最小救杆输出爬坡,到约1.2°进入完整救杆补偿,保持统一大小角度策略的同时避免除零。 - 在插值计算前增加
BALANCE_RESCUE_ANGLE_X100 > BALANCE_FALL_START_X100判断,防止后续改参时再次出现除零警告。
- 修复 Keil ARMCC 警告
- 验证: 待重新 Rebuild。预期
balance.c不再出现 division by zero warning。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 逻辑简化
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“仍然会往一个方向跑,希望小车尽量保持不动;大角度策略是对的,不要区分大小角度,而是一直把角度一点点调小”,简化平衡控制逻辑。
- 删除小角度软控制、回正阶段 Carry 弱阻尼、中心前防反向刹车等分段控制路径,避免不同角度区间切换时出现“中间停住/单方向加速”的行为。
- 全程统一使用
Balance_Angle_Kp = 4.2和Balance_Angle_Kd = 48.0做角度 PD,让角度误差连续被压小,不再因为进入小角度区而切换到另一套策略。 - 将救杆补偿阈值
BALANCE_RESCUE_ANGLE_X100从500降到120,约1.2°后即开始连续叠加救杆补偿,使大角度策略从小角度就逐步生效。 - 速度和位置反馈改为持续参与,
position_pwm不再因 falling/returning 阶段被暂停,目标是让小车尽量保持在原地附近,而不是长期往单方向跑。 - 保留极小角度静止窗口、速度漂移保护和最小输出爬坡;这些只用于防抖和防跑偏,不再改变角度控制策略。
- 验证: 待重新编译烧录。重点观察小角度阶段是否不再出现“到中间停住然后单方向加速”,以及小车是否更倾向于围绕起点附近修正。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 阻尼修正
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“大角度可以调小,但小角度会导致某一方向速度不断加快,最终没有速度余量而倒下”,增强小角度阶段的速度和位置约束。
- 将
Balance_Return_Speed_Kp从1.25提高到1.60,增强小角度回正和速度漂移阶段的车速阻尼。 - 将
Balance_Position_Kp从0.001提高到0.003,让小车在小角度长期偏跑时更早产生回中趋势,避免速度余量被单方向耗尽。 - 新增
BALANCE_DRIFT_SPEED = 900,当角度仍在软区但车速已经明显累积时,强制使用较高速度阻尼,防止小角度阶段继续单向加速。 - 新增
BALANCE_BIAS_POSITION = 8000,当小车位置已经明显偏离时暂停角度 Bias 学习,避免把实际漂移误当成零点偏差吃掉。
- 验证: 待重新编译烧录。重点观察小角度下
SF是否还能持续向单方向累积;若仍累积,需要检查SF符号是否在反向抵消输出。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 阻尼修正
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“大角度能明显左右摇晃修正,小角度只有加速、停下、再加速的循环,没有左右修正”,定位为上一版中心前防反向刹车保护范围过宽。
- 新增
BALANCE_RETURN_BRAKE_X100 = 250,约2.5°以上才启用“送杆到中心”的弱阻尼保护。 0.6°~2.5°小角度回正区重新允许正常Balance_Return_Speed_Kp和角速度 D 阻尼参与,让小角度也能出现左右修正,而不是只同方向加速/停下。- 位置回中暂停、Carry 弱阻尼和输出方向保护也都改为只在
abs_angle > BALANCE_RETURN_BRAKE_X100时生效,避免覆盖整个小角度调节区。
- 验证: 待重新编译烧录。重点观察
0.6°~2.5°内是否恢复左右微调;若小角度又开始抽动,再微调BALANCE_RETURN_BRAKE_X100或Balance_Return_Speed_Kp。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 阻尼修正
- 改动文件:
HAREWER/BALANCE/balance.c,DEVLOG.md - 内容:
- 根据实车反馈“延后回正减速后效果和没改差不多”,判断之前调小阻尼仍可能被角速度 D 项或速度反馈抵消,导致回正途中输出提前反向。
- 将
Balance_Carry_Angle_Kd从12.0降为0.0,回正但未进入中心捕获区前不再使用角速度 D 项刹车。 - 新增回正阶段输出方向保护:当杆子正在回正但仍未靠近中心线时,如果综合输出方向已经与角度方向相反,则强制回退为纯 P 输出。
- 目标是保证杆子还在同一侧时,小车不会过早反向刹车,而是继续把杆子带向中心线;进入中心捕获区后再恢复阻尼收敛。
- 验证: 待重新编译烧录。若该版仍然不能明显把杆子带到中心线,下一步应优先排查角度方向、编码器速度方向、四轮实际推力一致性或电机力矩余量,而不是继续细调阻尼参数。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 阻尼优化
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“每次摆回去一点,因为小车减速产生的加速度又把杆子摆回同一侧,停车时杆子仍不在中心附近”,调整回正阶段阻尼。
- 将中心捕获区从约
1.0°缩小到约0.6°,只有更接近中心线时才进入强阻尼刹车。 - 新增
Balance_Carry_Angle_Kd = 12.0,当杆子正在回正但仍未进入中心捕获区时,降低角速度 D 阻尼,避免 D 项过早抵消 P 项导致小车提前减速。 - 将
Balance_Carry_Speed_Kp从0.16降到0.04,进一步减少回正途中速度反馈造成的减速加速度。 - 回正但尚未靠近中心时暂停位置回中项,避免小车因为当前位置偏离而提前刹车;进入中心附近后再恢复速度/位置阻尼来收住。
- 验证: 待重新编译烧录。重点观察杆子被拉回时是否能继续向中心线靠近,而不是刚回一点就被减速带回同侧;若穿过中心后过冲,再提高中心捕获区内阻尼。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 电机输出补偿
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,HAREWER/PWM/pwm.c,DEVLOG.md - 内容:
- 根据实车反馈“竖直状态重新开始抖动,偏移时抖动很多但仍不能很好把杆子晃回中心线另一侧,阻尼有问题”,去掉上一版回正阶段的硬保底推力。
- 删除
BALANCE_RETURN_MIN_OUTPUT相关逻辑,避免杆子回正时被固定最小 PWM 硬推,导致中心附近跳变和抖动。 - 将
Balance_Return_Speed_Kp从1.55降到1.25,Balance_Carry_Speed_Kp从0.22降到0.16,让回正阶段阻尼更连续,不再过早刹死或硬推。 - 将 PWM 死区补偿从阶跃式改为渐进式:命令低于
MOTOR_PWM_CMD_FLOOR = 120时为 0,在120~900之间逐步叠加死区补偿,超过900后才使用完整1100补偿。 - 目标是保留克服静摩擦的能力,但避免小命令一超过阈值就突然跳到大 PWM,引发竖直附近抖动。
- 验证: 待重新编译烧录。重点观察竖直附近是否重新安静;若偏移时仍推不过中心线,下一步应从角速度/速度反馈符号和电机实际加速度一致性排查,而不是继续增加硬保底。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 参数调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“杆子倒向一边时,小车给的力只能让杆子回一点点就松力,无法到中心线另一边,最后只能逐渐加速直到速度用完”,调整回正阶段的刹车时机。
- 新增
BALANCE_CENTER_CAPTURE_X100 = 100,约1°内才认为进入中心捕获区,此时允许强回正阻尼刹车。 - 新增
Balance_Carry_Speed_Kp = 0.22,当杆子正在回正但仍离中心线较远时,降低速度阻尼,避免过早把追杆推力吃掉。 - 新增
BALANCE_RETURN_MIN_OUTPUT = 760,回正但尚未进入中心捕获区时保留一段最小穿越推力,帮助杆子真正越过中心线,而不是只回一点点就失去加速度。 - 原有
Balance_Return_Speed_Kp = 1.55保留,但只在进入中心捕获区后发挥主要作用,用于抑制穿越中心后的过冲。
- 验证: 待重新编译烧录。重点观察杆子被拉回时是否能穿过中心线;若穿过后过冲明显,再提高中心捕获区阻尼或降低
BALANCE_RETURN_MIN_OUTPUT。
- 改动者: WuWingKit
- 类型: 参数调整 / 控制策略调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“小角度加速度太小,杆子还没被摆回另一侧,小车速度已经逐渐耗掉;等角度大了再救时速度余量不足”,将救杆加速度前移到更小角度。
- 将
BALANCE_FALL_START_X100从300降到120,约1.2°且仍在远离零点时就启用倒杆最小救援输出。 - 将
BALANCE_FALL_MIN_OUTPUT从1250提高到1450,让小角度继续倒下时更早产生明显加速度,而不是慢慢拖着跑。 - 将普通最小输出从
320提高到480,但仍只在falling_away时触发,摆杆回正时不会强制最小输出。 - 将小角度
Balance_Soft_Angle_Kp从2.1提高到2.4,将Balance_Fall_Rate_Kd从44.0提高到58.0,增强小角度倒杆初期把角速度反向的能力。
- 验证: 待重新编译烧录。重点观察
1°~3°小角度扰动时是否能更早出现反向加速度;若竖直附近重新抖动,优先稍微降低BALANCE_MIN_OUTPUT或提高BALANCE_FALL_START_X100。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 调试增强
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,USER/main.c,DEVLOG.md - 内容:
- 根据实车反馈“小角度摇摆已有一次能摆正,但振荡中心会逐渐往一侧偏,最后偏到救不回来的角度”,新增慢速角度偏置补偿。
- 新增
Balance_Angle_Bias_X100和内部angle_bias_x100,只在角度、角速度、车速都较小时缓慢学习中心偏移,避免把大角度救杆过程误认为零点漂移。 - 偏置补偿限幅到
BALANCE_BIAS_LIMIT_X100 = 180,约 ±1.8°,用于修正手动调零误差、机械重心偏差和左右轮输出不一致造成的低频漂移,不允许无限漂移。 - 将原始角度变化和补偿后的控制角速度分开计算,避免偏置慢修正污染角速度 D 项。
- 串口调试输出新增
Bias字段,方便现场观察补偿是否正在向某一侧累积;若长期顶到 ±180,说明实际零点或机械偏置需要重新处理。
- 验证: 待重新编译烧录。重点观察小角度摇摆中心是否不再持续偏向一侧;若
Bias很快顶到限幅仍无法居中,需要重新竖直调零或检查车体/摆杆机械偏心。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 参数调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“大角度有明显反冲加速度能把杆子摆回来,但小角度会一直摇晃,无法找到竖直点,最终越摇越大”,重点调整竖直附近的收敛逻辑。
- 新增
returning_home状态判断:当角度和角速度反号时,说明摆杆正在往零点回正。 - 新增
Balance_Return_Speed_Kp = 1.55,在小角度回正阶段提高车速阻尼,让小车更早收力/刹车,减少穿过竖直点后的反向过冲。 - 将小角度软区从
Kp=2.4/Kd=24.0调整为Kp=2.1/Kd=34.0,降低位置拉扯、增加角速度刹车,目标是小角度更像阻尼系统而不是来回追逐。 - 将普通最小输出从
420降到320,并且只在摆杆继续远离零点falling_away时才启用最小输出;摆杆正在回正时不再强制打一脚最小 PWM,避免死区补偿把小摆动放大。
- 验证: 待重新编译烧录。重点观察小角度回正时是否能逐渐衰减;若仍然慢慢放大,下一步优先检查速度反馈符号或继续提高回正阻尼,而不是继续加大救杆。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 参数调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,HAREWER/PWM/pwm.c,DEVLOG.md - 内容:
- 根据实车反馈“竖直状态小车抖动很厉害,会把杆子越抖越大;偏离约 5° 后一直加速但救不回来”,将问题拆为零点附近噪声放大和倒杆阶段加速度不足两部分处理。
- 新增
BALANCE_HOLD_ANGLE_X100与BALANCE_HOLD_RATE_X100,当角度和角速度都处在很小范围内时直接输出 0,并清零位置积分,降低竖直附近由 ADC 抖动和角速度差分造成的电机抖动。 - 将小角度软区参数从
Kp=3.6/Kd=40.0降为Kp=2.4/Kd=24.0,减少竖直附近 D 项噪声被放大。 - 将普通区与救杆区参数提高到
Kp=4.2/Kd=48.0/RescueKp=2.4,并把救杆阈值从约6.5°提前到约5°。 - 增强倒杆阶段角速度救援,将
Balance_Fall_Rate_Kd提高到44.0,并将倒杆阶段速度反馈降到0.04,避免小车刚开始追杆就被速度反馈抵消。 - 新增
BALANCE_FALL_MIN_OUTPUT,当摆杆超过约3°且仍在远离零点时,强制给出更明显的最小救杆输出,让动作更像“打一脚加速度”。 - 在 PWM 死区补偿前新增
MOTOR_PWM_CMD_FLOOR = 80,极小命令直接视为 0,防止传感器微小噪声被1100死区补偿放大成明显抖动。
- 验证: 待重新编译烧录。测试时先观察竖直调零后是否基本不抖,再轻推到 3°~6° 看小车是否出现明显追杆加速度;若竖直仍抖,继续扩大 hold 窗口或降低软区 Kd。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 稳定性调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“微调明显了,但杆子往一边倒时小车只是逐渐加速,恒定加速度无法把杆子摆回正常范围”,调整倒杆阶段控制策略。
- 新增
Balance_Fall_Rate_Kd,当角度和角速度同方向,即摆杆正在继续远离零点时,额外叠加角速度救援输出,让电机输出更接近“给一脚更大的加速度”而不是只维持当前速度。 - 新增
Balance_Fall_Speed_Kp,倒杆阶段临时降低速度反馈权重,避免小车速度刚起来就被速度项抵消追杆力矩。 - 倒杆阶段暂停位置反馈,避免位置回中目标在救杆期间与追杆动作相互抵消;当摆杆开始回正后恢复速度/位置反馈来抑制冲过头。
- 保持基础小角度 P 参数不变,避免微调阶段重新变成过猛修正。
- 验证: 待重新编译烧录。重点观察串口
Ang和Rate:当二者同号时 PWM 应明显更积极;当Rate反号开始回正时,车速阻尼应重新参与,减少冲过头。
- 改动者: WuWingKit
- 类型: 电机输出补偿 / 稳定性调试
- 改动文件:
HAREWER/PWM/pwm.c,DEVLOG.md - 内容:
- 根据实车反馈“有微调动作但车不动,
P1000基本跑不起来”,判断当前主要问题不是电机 PID,而是电机/减速箱/地面静摩擦造成 PWM 死区。 - 当前工程没有独立电机速度 PID,
Set_PWM()直接将平衡控制输出写入 TIM5 占空比;因此小 PWM 会被静摩擦吃掉,表现为控制器有输出但小车不动。 - 在
Set_PWM()中新增Apply_PWM_Deadzone(),对非零电机命令增加MOTOR_PWM_DEADZONE = 1100的起步补偿。 - 增加
MOTOR_PWM_MAX = 7199限幅,避免补偿后超过 TIM5 当前 PWM 周期上限。 - 该补偿只在非零输出时生效,
Set_PWM(0,0,0,0)仍保持电机停止。
- 根据实车反馈“有微调动作但车不动,
- 验证: 待重新编译烧录。若小角度微调开始能推动小车,但动作过猛,可将
MOTOR_PWM_DEADZONE从1100下调到900;若仍推不动,可上调到1300。
- 改动者: WuWingKit
- 类型: 参数调整 / 稳定性调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“杆子往一边偏移时小车会逐渐加速,但不能把杆子拉回正常范围,最后一直加速直到倒下”,增强角度环和救杆段的追杆加速度。
- 将
BALANCE_PWM_LIMIT从5400提高到6200,增加最大追杆输出余量。 - 将
BALANCE_RESCUE_ANGLE_X100从1000降到650,约6.5°后提前进入救杆补偿,而不是等角度过大后才加强。 - 将
Balance_Angle_Kp从3.3提高到4.0,Balance_Soft_Angle_Kp从3.4提高到3.6,增强角度偏差对应的基础追杆力。 - 将
Balance_Angle_Kd从34.0提高到42.0,Balance_Soft_Angle_Kd从34.0提高到40.0,增强杆子刚开始倒下时的角速度响应。 - 将
Balance_Rescue_Kp从1.1提高到1.6,加大救杆区额外补偿。 - 将普通速度阻尼
Balance_Speed_Kp从1.35降到1.10,救杆阶段速度阻尼Balance_Rescue_Speed_Kp从0.75降到0.30,避免速度反馈过早抵消追杆输出。 - 需要重点观察串口中
PWM与SF的符号:若小车同向加速时SF与PWM符号相反,说明速度反馈方向可能反了,会导致越跑越快。
- 验证: 待重新编译烧录。若仍然一直加速但杆子不回正,下一步优先检查/翻转速度反馈符号或逐个校正四轮编码器方向,而不是继续单纯加大 PWM。
- 改动者: WuWingKit
- 类型: 架构调整 / 控制实时性优化
- 改动文件:
USER/main.c,DEVLOG.md - 内容:
- 参考 WHEELTEC 直线倒立摆示例程序,将核心平衡控制从
while(1)主循环迁移到 TIM1 定时中断中执行。 - 新增
Balance_Timer_Init(),使用 TIM1 按BALANCE_LOOP_MS固定周期触发控制闭环。 - 新增
TIM1_UP_IRQHandler(),在中断中完成角位移 ADC 采样、四轮编码器读取、Balance_Update()计算和Set_PWM()输出。 - 主循环改为只处理按键、串口命令、串口调试输出和 LCD 刷新,不再直接参与平衡闭环,避免 LCD/printf/按键扫描造成控制延迟。
- 串口和 LCD 显示由中断设置标志位,主循环消费标志位执行,结构更接近示例工程“中断控制、主循环显示”的模式。
- 按键扫描也改为由 TIM1 节拍置位后在主循环执行,避免移除主循环
delay_ms()后按键去抖计数过快。 - 调零时短暂停止 TIM1 控制中断,并停止 PWM 输出,避免 50 次 ADC 平均采样与中断中的角度采样抢占同一个 ADC 外设。
- 电池电压采样也迁移到 TIM1 中断的低频计数中,避免主循环和中断同时访问 ADC。
- 参考 WHEELTEC 直线倒立摆示例程序,将核心平衡控制从
- 验证: 待重新编译烧录。重点观察串口
PWM/Ang/Rate/SF是否按约 20ms 持续刷新,小角度扰动时 PWM 是否连续变化;若编译提示 TIM1 中断重定义,需要检查是否有其它文件实现了TIM1_UP_IRQHandler。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 调试优化
- 改动文件:
USER/main.c,HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“数据延迟还是高,基本看不见微调”,重新降低控制与调试链路延迟。
- 将
BALANCE_LOOP_MS从5ms调整为2ms,提高角度采样、编码器读取和 PWM 更新频率。 - 将编码器速度与角速度估算按 5ms 口径归一化,避免控制周期改变后 D 项和速度反馈量级突变。
- 将串口调试输出从约
50ms调整为约20ms,更容易观察小角度微调过程。 - 将 LCD 刷新降频到约
100ms,避免 LCD 大量刷屏阻塞平衡控制主循环。 - 将
BALANCE_START_ANGLE_X100从50降到20,约0.2°后开始允许起步补偿。 - 将
BALANCE_MIN_OUTPUT从430提高到520,并继续采用0.2°~6°线性爬升,增强可见微调但避免固定阈值突跳。 - 将
Balance_Soft_Angle_Kp从3.0提高到3.4,Balance_Angle_Kd从31.0提高到34.0,Balance_Soft_Angle_Kd从28.0提高到34.0,增强轻微扰动初期响应。
- 验证: 待重新编译烧录。重点通过串口观察
PWM、Ang、Rate是否在小角度变化时连续响应;若 LCD 显示慢但串口及时,以串口数据为准。
- 改动者: WuWingKit
- 类型: 参数调整 / 稳定性调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“竖直调零后,轻微施加干扰让杆子朝一边倒时小车追不上,且微调太少、等到角度偏移一定程度才猛冲”,在上一版降速基础上增强小角度微调和早期追杆能力。
- 将
BALANCE_PWM_LIMIT从4800提高到5400,给中等扰动保留更大的追杆余量。 - 将
BALANCE_START_ANGLE_X100从150降到50,约0.5°后即开始允许起步补偿,减少小角度无动作区。 - 将
BALANCE_MIN_OUTPUT从380提高到430,但改为在0.5°~6°内线性爬升,避免从小角度直接跳到固定最小输出造成猛冲。 - 将
Balance_Angle_Kp从3.0提高到3.3,Balance_Soft_Angle_Kp从2.1提高到3.0,提高小角度和中角度基础修正。 - 将
Balance_Angle_Kd从26.0提高到31.0,Balance_Soft_Angle_Kd从18.0提高到28.0,提高杆子刚开始倒下时的角速度响应。 - 将
Balance_Rescue_Kp从0.9提高到1.1,增强大于救杆阈值后的额外补偿。 - 将速度阻尼
Balance_Speed_Kp从1.55降到1.35,救杆阶段速度阻尼Balance_Rescue_Speed_Kp从0.95降到0.75,避免追杆初期被速度反馈过早压住。
- 验证: 待重新编译烧录。重点观察
0.5°~3°的小角度扰动是否开始有连续微调;若仍有明显“突然一脚”,下一步降低BALANCE_MIN_OUTPUT或继续拉宽爬升区间。
- 改动者: WuWingKit
- 类型: 参数调整 / 稳定性调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈“冲的速度太快”,将轻杆参数进一步调温和,优先降低小车冲出速度和反向过冲。
- 将
BALANCE_PWM_LIMIT从6200降到4800,限制最大追杆速度。 - 将
BALANCE_MIN_OUTPUT从520降到380,减小轻微角度时的起步突跳。 - 将
Balance_Angle_Kp从3.4降到3.0,Balance_Soft_Angle_Kp从2.4降到2.1,降低角度误差输出。 - 将
Balance_Angle_Kd从28.0降到26.0,Balance_Soft_Angle_Kd从20.0降到18.0,降低快速扰动时的过猛响应。 - 将
Balance_Rescue_Kp从1.2降到0.9,减小大角度额外救杆补偿。 - 将普通速度阻尼
Balance_Speed_Kp从1.35提高到1.55,救杆阶段速度阻尼Balance_Rescue_Speed_Kp从0.70提高到0.95,让小车更早收速。
- 验证: 待重新编译烧录。若速度明显变柔但追杆不足,优先小幅提高
BALANCE_PWM_LIMIT到5200,不要先提高BALANCE_MIN_OUTPUT。
- 改动者: WuWingKit
- 类型: Bug 修复 / 引脚复用修复
- 改动文件:
HAREWER/LCD/lcd_init.c,DEVLOG.md - 内容:
- 针对烧录后 LCD 背光亮但全白的问题,排查发现 LCD 的 SCLK 使用
PB4,而PB4默认是 JTAG 的NJTRST引脚。 - 之前为了保留 SWD,将
GPIO_Remap_SWJ_Disable修正为GPIO_Remap_SWJ_JTAGDisable是正确的,但关闭 JTAG 的动作发生在LCD_Init()之后,导致 LCD 初始化时PB4仍未释放为普通 GPIO。 - 在
LCD_GPIO_Init()中启用RCC_APB2Periph_AFIO,并在配置PB4~PB9前调用GPIO_Remap_SWJ_JTAGDisable,只关闭 JTAG、保留 SWD,同时释放PB4给 LCD SCLK 使用。 - 该修复保证 LCD 初始化不依赖编码器初始化顺序,也避免再次关闭 SWD 下载调试口。
- 针对烧录后 LCD 背光亮但全白的问题,排查发现 LCD 的 SCLK 使用
- 验证: 待重新编译烧录。预期 BOOT0 接 GND 后上电,LCD 不再白屏,应显示正常调试页面。
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件适配
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车反馈,原摆杆过重导致小车跑到最大速度仍追不上;减轻摆杆后,原先为重杆设置的高输出和强救杆补偿会偏激进,因此重新调整为轻杆参数。
- 将
BALANCE_PWM_LIMIT从7190降到6200,避免轻杆状态下小车过快冲出导致反向过冲。 - 将
BALANCE_SAFE_ANGLE_X100从5500降到4500,回到更保守的保护范围,减少大角度无效追杆。 - 将
BALANCE_MIN_OUTPUT从650降到520,轻杆所需起步力更小,减少小角度突然冲动。 - 将
Balance_Angle_Kp从4.0降到3.4,Balance_Soft_Angle_Kp从2.8降到2.4,降低角度误差对应的基础输出。 - 将
Balance_Angle_Kd从32.0降到28.0,Balance_Soft_Angle_Kd从24.0降到20.0,降低快速变化时的过激反应。 - 将
Balance_Rescue_Kp从2.2降到1.2,减小大角度额外救杆补偿。 - 将普通速度阻尼
Balance_Speed_Kp从1.20提高到1.35,救杆阶段速度阻尼Balance_Rescue_Speed_Kp从0.25提高到0.70,让轻杆追回后更容易收住车速。
- 验证: 待重新编译烧录。建议先用手扶杆小角度扰动测试,观察小车是否能补救且不过度冲出;若仍追不上,再小幅提高
Balance_Angle_Kd或BALANCE_PWM_LIMIT。
- 改动者: WuWingKit
- 类型: 调试收尾 / 功能恢复
- 改动文件:
USER/main.c,DEVLOG.md - 内容:
- 确认 BOOT0/BOOT1 方式可重新烧录后,板子已能从 Flash 启动并显示 LCD 调试页面。
- LCD 显示
T/A/B/C/D等字段说明程序已经进入主循环,启动诊断信息会被周期性调试页面覆盖,属于正常现象。 - 将
STARTUP_DIAGNOSTIC_MODE从1改为0,恢复执行Encoder_Timer_Init(),使 D 轮软件编码器重新参与运行。 - 保留
GPIO_Remap_SWJ_JTAGDisable修复,避免后续程序运行后再次关闭 SWD 下载调试口。
- 验证: 待重新编译烧录。烧录后
BOOT0接回 GND 并重新上电,LCD 应显示正常调试页面,后续 Keil/ST-Link 应仍可通过 SWD 连接。
- 改动者: WuWingKit
- 类型: Bug 修复 / 下载恢复
- 改动文件:
HAREWER/ENCODER/encoder.c,DEVLOG.md - 内容:
- 排查“刷入程序后板子像卡在 BOOT0、BOOT0 拉低也不运行、后续烧录无效”的问题,发现
Encoder_Init_Tim2()中使用了GPIO_Remap_SWJ_Disable。 GPIO_Remap_SWJ_Disable会同时关闭 JTAG 和 SWD,程序一旦运行到 TIM2 编码器初始化,PA13/PA14 的 SWD 调试下载口会被关闭,导致 ST-Link/Keil 断联,表现为只能通过 BOOT0 或复位抢连。- 将其改为
GPIO_Remap_SWJ_JTAGDisable,只关闭 JTAG、释放 PA15/PB3 给 TIM2 编码器使用,同时保留 SWD 下载调试能力。 - 该改动不影响 TIM2 完全重映射使用 PA15/PB3,但能避免用户程序运行后把调试口锁死。
- 排查“刷入程序后板子像卡在 BOOT0、BOOT0 拉低也不运行、后续烧录无效”的问题,发现
- 验证: 待重新编译烧录。建议使用 ST-Link/CMSIS-DAP 以
Connect under reset或按住复位连接,烧录该版本后 BOOT0 保持接 GND,后续应可正常复位运行并重新下载。
- 改动者: WuWingKit
- 类型: 调试增强 / 启动诊断
- 改动文件:
USER/main.c,DEVLOG.md - 内容:
- 针对
BOOT0拉低后仍然出现“LCD 不亮、复位无反应”的问题,新增启动阶段诊断显示。 - 新增
STARTUP_DIAGNOSTIC_MODE,上电后先初始化串口与 LCD,再逐步显示BOOT LCD OK、GPIO OK、KEY OK、ADC OK、PWM OK等阶段标记。 - 诊断模式下临时跳过
Encoder_Timer_Init(),用于排查 TIM6 软件编码器高频中断是否导致主循环、LCD 或按键响应异常。 - PWM 初始化后立即执行
Set_PWM(0, 0, 0, 0),确保诊断阶段电机保持停止。
- 针对
- 验证: 待重新编译烧录。若 LCD 显示到
ENC TIMER SKIP,说明程序启动正常,后续重点排查 TIM6/编码器中断;若仍完全无显示,优先检查 Keil 下载目标、复位/BOOT 引脚、电源、晶振和 LCD 背光供电。
- 改动者: WuWingKit
- 类型: 回退 / 稳定性调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,HAREWER/ENCODER/encoder.c,USER/main.c,DEVLOG.md - 内容:
- 根据烧录后“屏幕不亮、按按钮也没反应”的现象,按要求回退到修改控制周期之前的代码状态。
- 将
BALANCE_LOOP_MS恢复为5ms,撤回2ms控制周期实验。 - 将
BALANCE_MIN_OUTPUT恢复为650,撤回上一版更激进的起步补偿。 - 将
Balance_Angle_Kd恢复为32.0,Balance_Soft_Angle_Kd恢复为24.0。 - 恢复
USER/main.c中 LCD/串口调试周期与初始化顺序到控制周期实验前版本。 - 恢复
HAREWER/ENCODER/encoder.c中 TIM6 软件编码器轮询频率到控制周期实验前版本。
- 验证: 待重新编译烧录。预期行为与
193ed05 tune: improve small angle startup response基本一致,仅新增本回退日志。
- 改动者: WuWingKit
- 类型: 参数调整 / 控制策略调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“起步响应太慢,轻微转动时基本没有补救”的现象,提高小角度软控制区响应。
- 将
Balance_Soft_Angle_Kp从2.2提高到2.8,增强 ±6° 内的基础角度修正。 - 将
Balance_Soft_Angle_Kd从20.0提高到24.0,增强轻微转动时的角速度响应。 - 新增
BALANCE_START_ANGLE_X100 = 150和BALANCE_MIN_OUTPUT = 650,当角度超过约1.5°且计算输出低于起步阈值时,补偿最小 PWM 以克服电机静摩擦。 - 最小起步补偿不在零点附近生效,避免调零后无角度时电机持续抖动。
- 验证: 待硬件测试。重点观察轻微前后转动时轮子是否能及时开始补救;若又出现小角度过冲,优先将
BALANCE_MIN_OUTPUT降到500。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 调试增强
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,USER/main.c,DEVLOG.md - 内容:
- 根据实车测试“小车来回调整三次后倒下、杆子有时径直倒向一边且小车只加速一下就停、加速很快仍救不起来”的现象,进一步区分近竖直阻尼和大角度救杆阶段。
- 将
BALANCE_PWM_LIMIT从7100提高到7190,尽量接近当前 10kHz PWM 周期上限,提高极限救杆输出。 - 将
BALANCE_SAFE_ANGLE_X100从4500提高到5500,允许更大角度范围内继续尝试救杆,并通过串口输出停机原因辅助判断是否提前保护。 - 将
Balance_Rescue_Kp从1.6提高到2.2,增强大角度救杆补偿。 - 新增
Balance_Rescue_Speed_Kp = 0.25,在角度超过救杆阈值时弱化速度阻尼,避免杆子还没追上时速度反馈过早抵消输出。 - 将普通速度阻尼从
1.10提高到1.20,近竖直阶段仍保持较强刹车能力,减少来回调整后的过冲。 - 新增
Balance_Stop_Reason,串口输出增加Stop与SF字段,用于区分角度保护停机、人工停机以及速度反馈状态。 - 将 KEY2 和串口
z调零从单次 ADC 采样改为Get_adc_Average(ADC_Channel_14, 50),降低手动定零抖动和瞬时采样误差。
- 验证: 待硬件测试。建议启动前尽量扶直摆杆并保持 1 秒后再按 KEY2;若串口出现
Stop=1,说明角度超过保护范围自动停机;若大角度时PWM明显被SF抵消,需要继续降低Balance_Rescue_Speed_Kp。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 参数调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“轻微角度修正太大,导致修正过度并朝反方向运动”的现象,新增小角度软控制区。
- 新增
BALANCE_SOFT_ANGLE_X100 = 600,约 ±6° 以内使用更低的角度增益和角速度增益。 - 新增
Balance_Soft_Angle_Kp = 2.2,小角度基础修正力度低于正常区Balance_Angle_Kp = 4.0。 - 新增
Balance_Soft_Angle_Kd = 20.0,小角度角速度响应低于正常区Balance_Angle_Kd = 32.0。 - 将额外救杆触发角度从约
8°调整到约10°,避免轻微偏移时过早叠加强力救杆输出。 - 保留大角度救杆补偿和
7100PWM 上限,使明显倾倒时仍有足够追杆能力。
- 验证: 待硬件测试。重点观察 ±3°~±6° 内是否还会一修正就冲过头;若小角度仍过冲,下一步继续下调
Balance_Soft_Angle_Kp到1.8。
- 改动者: WuWingKit
- 类型: 控制策略调整 / 参数调整
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“慢速偏移能救回但会救过头并快速倒向另一边、初始已有倾斜时一直加速仍救不回来”的现象,调整为近竖直更柔、大角度更强的控制策略。
- 将
BALANCE_PWM_LIMIT从6800提高到7100,进一步接近当前 PWM 周期上限,提高极限救杆速度。 - 将
BALANCE_SAFE_ANGLE_X100从4000提高到4500,允许约 ±45° 范围内继续尝试救杆。 - 将基础角度 P 从
4.1微降到4.0,避免小角度慢偏移时过度追杆。 - 将角速度 D 从
32.0提高到36.0,增强快速倒杆时的提前响应。 - 新增
Balance_Rescue_Kp = 1.6,当角度超过约8°后叠加非线性救杆补偿,小角度不额外放大,大角度更有力。 - 将速度反馈从
0.65提高到1.10,并将速度滤波从7:3调整为1:1,让小车冲出去后更早被速度项拉住,改善救过头后换向来不及的问题。
- 验证: 待硬件测试。若启动后小车一加速反而更收不住,优先检查串口输出中
PWM与四个编码器速度符号是否同向;若方向相反,说明速度反馈符号需要翻转。
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“能勉强维持更久但速度仍不够、快速下落仍追不上”的现象继续增强追杆能力
- 将
BALANCE_PWM_LIMIT从6000提高到6800,接近 10kHz PWM 周期上限但保留余量,用于提高快速下落时的小车追杆速度 - 将
BALANCE_SAFE_ANGLE_X100从3500提高到4000,允许约 ±40° 范围内继续救杆,避免还没追上就提前停机 - 将角度 P 从
3.8小幅提高到4.1,增加角度偏差对应的基础修正力 - 将角速度 D 从
24.0提高到32.0,增强对快速下落趋势的响应,优先解决“刚开始快速倒就追不上”的问题 - 将速度反馈从
0.55提高到0.65,在提高追杆速度的同时增加速度阻尼,减少追回后继续冲过头
- 验证: 需重新烧录后人工扶正摆杆,按
KEY2启动,先测试小角度快速扰动;若出现明显高频抖动,优先回退角速度 D 到28.0
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“慢速偏移能追回但会过头,快速下落可能追不上”的现象进行组合调参
- 将
BALANCE_SAFE_ANGLE_X100从2500提高到3500,自动停机范围放宽到约 ±35° - 将
BALANCE_PWM_LIMIT从5200提高到6000,提高快速追杆时的最大输出 - 将角度 P 从
4.2降到3.8,减少慢速修正时的追过头 - 将角速度 D 从
18.0提高到24.0,增强快速下落时的预判和抑制 - 将速度反馈从
0.40提高到0.55,增加前后运动阻尼,减少小车冲过头
- 验证: 需重新烧录后分别测试慢速前后倾和快速扰动,观察是否更少过冲且快速下落时更能追上
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 针对摆杆较长较重、偏移后下落较快的机械特性,将
BALANCE_PWM_LIMIT从4200提高到5200 - 将角度环参数从
Kp=3.4, Kd=13.0调整到Kp=4.2, Kd=18.0 - 将速度反馈
Balance_Speed_Kp从0.55降到0.40,位置反馈Balance_Position_Kp从0.002降到0.001 - 目标是增强前后追杆能力,减少速度/位置反馈在初期对追杆动作的抑制
- 针对摆杆较长较重、偏移后下落较快的机械特性,将
- 验证: 需重新烧录后人工扶正摆杆,按 KEY2 启动,观察是否能更快追上长重摆杆
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车调试需要,将
BALANCE_SAFE_ANGLE_X100从1500调整为2500 - 自动停机角度范围由约 ±15° 放宽到约 ±25°,避免调参时过早关闭电机
- 根据实车调试需要,将
- 验证: 需重新烧录后确认轻微大角度偏移不会立即停机,同时超过可控范围仍能保护停机
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“速度仍然偏慢”的现象,将
BALANCE_PWM_LIMIT从3200提高到4200 - 将角度环参数从
Kp=2.4, Kd=9.5调整到Kp=3.4, Kd=13.0 - 暂时保持
Balance_Speed_Kp=0.55不变,优先增强前后追杆能力
- 根据实车测试“速度仍然偏慢”的现象,将
- 验证: 需重新烧录后观察前后追杆速度是否明显提升,若出现高频抖动再回退
Kd
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 在前后运动方向已确认正确后,将
BALANCE_PWM_LIMIT从2500提高到3200 - 将角度环参数从
Kp=1.8, Kd=7.0调整到Kp=2.4, Kd=9.5 - 目标是提高小车前后追杆速度和姿态响应速度,同时保留当前速度反馈抑制冲出
- 在前后运动方向已确认正确后,将
- 验证: 需重新烧录后人工扶正摆杆,按 KEY2 启动,观察响应是否更快且没有恢复到猛冲状态
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“杆子前倾时小车后退”的现象,将
BALANCE_OUTPUT_SIGN从-1调整为1 - 目标是让摆杆前倾时小车向前运动,摆杆后倾时小车向后运动
- 根据实车测试“杆子前倾时小车后退”的现象,将
- 验证: 需重新烧录后人工扶正摆杆,轻微前倾观察小车是否向前追杆
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据实车测试“冲得太快,无法微调”的现象,将
BALANCE_PWM_LIMIT从6500降到2500 - 将角度环参数从
Kp=5.0, Kd=18.0降到Kp=1.8, Kd=7.0 - 将速度反馈
Balance_Speed_Kp从0.35提高到0.55,帮助抑制小车持续冲出
- 根据实车测试“冲得太快,无法微调”的现象,将
- 验证: 需重新烧录后人工扶正摆杆,按 KEY2 启动,观察小车是否能以更小动作前后修正
- 改动者: WuWingKit
- 类型: 参数调整 / 硬件调试
- 改动文件:
HAREWER/BALANCE/balance.h,DEVLOG.md - 内容:
- 根据硬件测试现象“平衡方向反”,将
BALANCE_OUTPUT_SIGN从1调整为-1 - 用于反转角度控制到四轮同步 PWM 的输出方向
- 根据硬件测试现象“平衡方向反”,将
- 验证: 需重新烧录后再次人工扶正摆杆,按 KEY2 启动,观察小车是否朝纠正摆杆倾倒的方向运动
- 改动者: WuWingKit
- 类型: Bug 修复
- 改动文件:
SYSTEM/usart/usart.c,SYSTEM/usart/usart.h,DEVLOG.md - 内容:
- 将
USART_RX_STA的声明和定义统一为volatile u16 - 修复 ARMCC 报错
declaration is incompatible with "volatile u16 USART_RX_STA"
- 将
- 验证: 已根据 Keil 报错定位并完成静态检查;需重新 Rebuild 确认工程通过编译
- 改动者: WuWingKit
- 类型: 新增功能 / 控制算法移植
- 改动文件:
USER/main.c,USER/key.c,HAREWER/BALANCE/balance.c,HAREWER/BALANCE/balance.h,USER/Tb6612demo.uvprojx,DEVLOG.md - 内容:
- 参考 IP570 直线倒立摆源码的 5ms 控制节拍、角度 PD、位置/速度反馈、PWM 限幅和倾角保护思路
- 面向四轮小车场景新增
HAREWER/BALANCE控制模块,四个电机同步输出同一平衡 PWM - 不移植直线滑轨自动起摆流程,改为人工扶正摆杆后按 KEY2 调零并进入平衡控制
- 将主循环从 50ms 调试循环改为 5ms 控制循环,LCD/串口仍按 50ms 刷新,电池电压按 100ms 刷新
- KEY3 和串口
s可停止平衡输出;串口z保留为调零并启动平衡的备用入口 - 按键扫描改为非阻塞多帧消抖,避免控制循环被按键等待卡住
- 新增
BALANCE_OUTPUT_SIGN用于现场快速翻转角度控制输出方向
- 验证: 已完成代码静态检查和 Keil 工程 XML 解析检查;需硬件烧录后从低占空比参数开始确认电机方向、角度极性和安全停机阈值
- 改动者: WuWingKit
- 类型: 新增功能 / 调试优化
- 改动文件:
USER/main.c,USER/key.c,USER/key.h,USER/Tb6612demo.uvprojx,DEVLOG.md - 内容:
- 参考
E:\WorkSpace\倒立摆\rfid工程的按键实现,新增USER/key.c/USER/key.h - 避开已被 TIM5_CH1 电机 PWM 占用的 PA0,仅初始化 PC8/PC9 按键输入
- 将 KEY2(PC8,低电平按下) 作为 WDD35D4 角位移传感器调零键,按下后把当前
angle_adc写入zero_offset - 保留串口
z调零作为备用路径,同时启动提示增加 KEY2 调零说明 - 将
key.c加入 Keil 工程 USER 分组,确保工程编译包含按键驱动
- 参考
- 验证: 已完成代码静态检查;需在硬件上烧录后竖直放置杆体,按 KEY2,观察 LCD
Ang接近 0 且串口输出Zero set by KEY2!
- 改动者: WuWingKit
- 类型: 新增功能 / 文档更新
- 改动文件:
HAREWER/ADC/adc.c,HAREWER/FILTER/filter.c,HAREWER/FILTER/filter.h,USER/main.c,引脚汇总.md,DEVLOG.md - 内容:
- ADC 初始化增加 PC4 (ADC1_CH14),用于 WDD35D4 角位移传感器采样
- 新增卡尔曼滤波器 + 一阶互补滤波器(从 WHEEL_ADC 项目迁移)
- main.c 切换为传感器测试模式:电机全部禁用,仅读取 WDD35D4 角度数据
- LCD 显示:原始 ADC 值、转换后角度值、电池电压
- 串口输出角度数据 @ 20Hz
- WDD35D4 接线:VCC→3.3V, GND→GND, 信号→PC4
- 更新引脚汇总文档
- 验证: 待硬件测试 — 上电后 LCD 应显示 ADC 原始值和角度,手动旋转传感器时数值变化
- 改动者: WuWingKit
- 类型: 文档更新
- 改动文件:
README.md,README_CN.md,DEVLOG.md - 内容:
- 新增
README.md(英文主文档),包含硬件平台、引脚分配、项目结构、当前进度、协作流程 - 新增
README_CN.md(中文文档),英文版通过链接指向中文版 - 修复
DEVLOG.md中遗留的 Git 合并冲突标记(<<<<<<< HEAD/=======/>>>>>>>),合并 hzx 与 tulip627722 的两条日志 - 统一所有开发日志条目格式,修正不规范写法
- 新增
- 验证: 文档推送到 GitHub 后可正常渲染
- 改动者: tulip627722
- 类型: Bug修复 / 参数调整
- 改动文件: HAREWER/MOTO/moto.c, HAREWER/PWM/pwm.c, HAREWER/ENCODER/encoder.c, USER/main.c
- 内容:
- B 电机方向修正: 根据实际接线(BIN1=PB13, BIN2=PB12)修正 moto.c 和 pwm.c 中的引脚配置(交换 PB12/PB13)
- B 编码器读数取反: encoder.c Read_Encoder case 2 中加负号,匹配硬件编码器接线方向
- PID 参数调优: Kp 从 1.0 降至 0.5,Ki 从 3.0 降至 0.15,解决电机正反来回震荡问题,加减速更平滑
- 目标速度降低: TargetVelocity 从 500 降至 300,实现低速直行调试
- 验证: 四轮同向稳定运转,PWM 平滑调节不再爬升至满速
- 改动者: hzx, tulip627722
- 类型: 功能调整 / 文档更新
- 改动文件:
HAREWER/ENCODER/encoder.c,HAREWER/ENCODER/encoder.h,USER/main.c,引脚汇总.md - 内容:
- 新建
引脚汇总.md,记录 STM32 实际硬件引脚映射表(PWM / 方向 / 编码器 / ADC / LCD) - 编码器 E4 (D电机) 实际使用 PA8 (A相) / PA4 (B相),与代码中 PB10/PB11 不同,代码待适配
- C 电机编码器 E3 实际接线 PA7 (A相) / PA6 (B相),与代码中 PA6/PA7 的 A/B 相对应交换
- B 电机方向引脚实际接线 BIN1=PB13 / BIN2=PB12
- STBY 引脚直连 3.3V(常使能)
- D 编码器从主循环 50ms 轮询改为 TIM6 定时器中断轮询(50kHz),解决高速时脉冲丢失导致读数一直为 0/-1 的问题
- 50kHz 下 D 轮读数从 300 提升至 3000+,与其他轮(5000+)接近
- TIM6 中断优先级设为 1,不影响其他外设中断
- 新建
- 验证: D 编码器可稳定读数,四轮速度闭环控制正常,小车可直线运行
- 改动者: WuWingKit
- 类型: Bug修复
- 改动文件:
HAREWER/ENCODER/encoder.c - 内容:
TIM8_IRQHandler→TIM8_UP_IRQHandler:HD 启动文件将 TIM8 拆分为 4 个独立中断向量(TIM8_UP_IRQHandler),旧名称与向量表不匹配,溢出时会导致 MCU 死循环- 修正
Encoder_Init_Tim8()函数注释(误标为 TIM1) - 修正
Encoder_Init_Tim3()函数注释(误标为 TIM2) - 排查 C/D 电机编码器读 0/-1 问题:TIM3 代码逻辑无 bug,软件编码器 PB10/PB11 配置无 bug,疑为硬件连接问题
- 验证: 编译通过,待硬件调试确认 C/D 问题
- 改动者: tulip627722
- 类型: 功能调整 / Bug修复
- 改动文件: HAREWER/LCD/lcd_init.c, HAREWER/LCD/lcd_init.h, HAREWER/ENCODER/encoder.c, USER/main.c, USER/Tb6612demo.uvprojx, HAREWER/MOTO/moto.c, CORE/startup_stm32f10x_hd.s
- 内容:
- LCD 恢复PDF原始引脚(PB4~PB9),SCLK/PB4, MOSI/PB5, RES/PB6, DC/PB7, CS/PB8, BLK/PB9
- D编码器从PB14/PB15改到PB10/PB11(PB14被E3B占用)
- 启动文件从 _md.s 更换为 _hd.s(适配STM32F103RCT6高密度芯片)
- 恢复LCD初始化序列为原始参数(修复白屏问题,LCD已正常显示调试数据)
- PWM限幅从7200调整为7500
- 验证: LCD显示正常,A轮速度读数稳定,B/C/D轮待进一步调试
- 改动者: WuWingKit
- 类型: 项目配置
- 改动文件:
.gitignore,CONTRIBUTING.md,DEVLOG.md - 内容:
- 初始化 Git 仓库
- 添加
.gitignore,忽略 Keil 编译产物(*.axf,*.hex,*.o,*.d等) - 首次提交:81 个文件,42,767 行代码
- 推送到 GitHub:
https://github.com/WuWingKit/Inverted-pendulum - 编写
CONTRIBUTING.md团队协作指南 - 编写
DEVLOG.md开发文档,梳理当前项目架构与状态
- 验证: 推送成功,GitHub 仓库可正常访问
格式说明: 每次改动按照以下模板追加到「开发日志」上方:
### YYYY-MM-DD — 改动简述 - **改动者:** 姓名 - **类型:** 新增功能 / Bug修复 / 参数调整 / 文档更新 - **改动文件:** `HAREWER/XXX/xxx.c` - **内容:** 详细描述 - **验证:** 如何验证