🤖 整机调试实战:步态调参与故障排查

1 整机调试总流程:六阶段路线图

整机调试最大的坑是「一步到位」:刚把 12 个关节拧上腿就急着让它走路,结果一旦抖动、发热、摔倒,你分不清是哪个关节、哪一环的问题。正确做法是把调试分层递进,每一阶段只验证一件事,通过了再进入下一阶段。

每阶段的验收标准要「可测量、可复现」,不要用「感觉还行」这种主观判断。下表给出每个阶段常用的量化门槛:

2 关节级整定实战:FOC 三环、谐振与摩擦

整机走得好不好,先看每个关节「听不听话」。关节级整定的核心是由内向外:先把电流环(力矩环)调好,再包速度环,最后包位置环。内环是外环的「执行机构」,内环不稳,外环永远调不稳。

2.1 FOC 电流环整定

电流环是力矩的直接来源,它决定了关节的「硬度」和响应速度。整定目标是:阶跃电流响应快、无振荡、跟踪误差小,即带宽和相位裕度达标。对关节模组,电流环带宽约 300Hz~1kHz 是常见目标,高性能场合可到约 2kHz 以上;相位裕度目标约 45°~60°,增益裕度约 6~10dB(小于此值易振荡)。

整定步骤(以本项目 SimpleFOC 生态为例):

1. 先标定采样零点:电机不转时读三相电流,校掉 INA240 偏置(1.65V 参考偏置),否则低速时电流环会「乱抖」。
2. 开环验证:给一个低频小电压/小电流开环驱动,确认相电流正弦、电机平稳旋转、方向正确。
3. 阶跃激励:施加一个电流阶跃指令(如 0 → 1A,约为额定电流的 10%~20%),观察实测电流响应。
4. 加比例 Kp:从 0 逐步加大 Kp,直到阶跃响应「接近一条直角边」但不出现明显振荡;继续加若出现等幅/发散振荡或可闻啸叫,说明增益过高,回退到约 70%~80%。
5. 加积分 Ki:Ki 用来消除稳态电流误差,但过大导致超调与低频振荡。Ki 的合理量级约为「Kp ÷ 电机电气时间常数(约 L/R)」。
6. 验证带宽:用小幅正弦扫频(或阶跃上升时间)复核带宽与相位裕度,确认无振荡后再交给速度环。

# SimpleFOC 电流环整定示意(伪代码,数值为示例)
motor.voltage_power_supply = 24;      # 母线电压
driver.voltage_limit = 12;            # 调试期先限幅,防止过冲
motor.PID_current_q.P = 8.0;          # 电流环比例(示例,按电机电感调整)
motor.PID_current_q.I = 400.0;        # 电流环积分(约 = P / (L/R))
motor.PID_current_d.P = 8.0;          # d 轴同理
motor.PID_current_d.I = 400.0;
motor.current_limit = 25.0;           # 电流限幅(堵转保护)
# 调试:从 P=0 起步,逐步加大;出现啸叫即回退

2.2 速度环 / 位置环 PID 整定步骤与参数判断

速度环与位置环通常用串级 PI/PID,整定顺序仍是先内后外。工程上常用齐格勒-尼科尔斯(Ziegler-Nichols)临界比例法起步:先只加比例,逐步增大直到系统出现持续等幅振荡,记下此时的临界增益 Ku 与振荡周期 Tu,再按经验公式取整——PID 时约 Kp = 0.6Ku、Ti = 0.5Tu、Td = 0.125Tu,PI 时约 Kp = 0.45Ku、Ti = 0.83Tu。这个方法给出的是「能跑」的初值,之后还要微调。

判断口诀:「比例管快慢、积分管误差、微分管阻尼」。位置环典型带宽约 20~100Hz,速度环约 50~200Hz(约为电流环的 1/10~1/5),带宽由内向外逐层递减——外环快不过内环,否则会「催着内环跑」导致振荡。整定完成标准:位置阶跃「快、稳、准」——上升时间尽量短、超调 < 约 10~20%、无振荡、静差接近 0。

2.3 机械谐振与陷波滤波器

关节不是刚体:电机惯量通过减速器/谐波、联轴器连到负载,构成双惯量系统,传动链的柔顺性会在几百 Hz~几 kHz 处产生一个机械谐振峰。当速度环/位置环带宽接近这个频率时,系统会剧烈振动、啸叫甚至损坏减速器——这就是「增益一加就抖」的常见根源。

如何测谐振频率:① 开环扫频:不闭环,给电机施加幅值很小的正弦速度/电流激励,从低频扫到高频,记录速度幅值响应,找到幅值显著放大的峰值频率(反谐振点附近也一并记录);② 白噪声激励 + FFT:注入宽带小信号,对速度/电流做 FFT 找谱峰;③ 自整定辨识:很多伺服驱动器自带在线辨识(基于 FFT 的谐振特征辨识)。测得谐振频率 f_r 后,在速度环输出(或电流指令前)串入一个陷波滤波器(notch filter):

工程要点:陷波中心频率会随负载和姿态漂移(负载越大、等效惯量越大,谐振频率越低),所以固定陷波只适合负载基本不变的关节;负载变化大时优先用自适应陷波(在线辨识 f_r 并实时跟踪)。陷波深度不是越深越好——太深会吃掉相位裕度,一般先「浅陷波 + 降增益」组合处理。

2.4 前馈与摩擦补偿(库仑/粘滞摩擦辨识)

关节运动时,摩擦会吃掉一部分力矩,表现为:低速时「顿挫」(爬行)、换向时位置「死区」、速度环跟随滞后。摩擦最常用的模型是库仑 + 粘滞:

辨识方法(恒速法):让关节以多个恒定速度 ω₁…ωₙ 正转和反转(电流环闭环、速度开环给恒定电压/电流),每点记录平均力矩(电流 × 扭矩系数);以 ω 为横轴、平均 τ 为纵轴做线性拟合,截距≈库仑摩擦 F_c,斜率≈粘滞摩擦 B(正反转符号相反,取绝对值)。

# 摩擦辨识伪代码(恒速法)
for w in [0.5, 1, 2, 4, 8]:          # 多个恒定速度点(rad/s)
    for sign in [+1, -1]:            # 正反转各测一次
        drive_openloop(w * sign)     # 开环给到该速度,等稳定
        tau_avg = mean(iq) * Kt      # 平均力矩 = 平均电流 × 扭矩系数
        record(w, sign, tau_avg)     # 记录 (速度, 方向, 平均力矩)
# 拟合 tau_avg = Fc + B*|w| ,得到 Fc、B

得到 F̂c、B̂ 后,把它们作为前馈加到速度环输出上:

有了前馈,反馈环只需「修小误差」,带宽要求下降、跟踪更跟手。注意两点:① sign() 在零速附近会来回跳变,工程上常用 tanh() 平滑或加死区;② 摩擦系数会随温度、润滑老化变化,定期重辨识。

3 通信与同步调试:帧率、抖动、丢帧与上电时序

整机有十几个到几十个关节,「单关节调好」不等于「整机协调」——关节之间靠总线串起来,总线延迟与抖动会直接变成整机的不稳定。本节讲关节模组联网时最容易踩的坑。

3.1 CAN / EtherCAT 总线帧率与控制周期

控制周期怎么选:位置/速度指令下发周期要和内环匹配——位置环周期通常取约 1ms(EtherCAT 的 1kHz 或 CAN 的 1ms),电流环则永远在关节 MCU 内部以更高频(约 10~40kHz)独立跑。外层指令周期太长会「一顿一顿」,太短又浪费总线带宽。

3.2 控制周期抖动与多关节同步

抖动(jitter)指控制周期实际执行时刻的波动。抖动大时,即使平均周期正确,位置环的「采样时刻忽快忽慢」也会带来抖动噪声甚至振荡。降低抖动的手段:① 用硬件定时器中断而不是软件 delay() 生成控制节拍;② 总线用主站硬件时间戳/分布式时钟(EtherCAT DC)对齐;③ 把通信接收放进中断/DMA,避免主循环耗时导致丢节拍。

多关节同步的要求:所有关节在同一个控制周期里采样、执行,指令带时间戳,过期指令丢弃。EtherCAT 靠 DC 把各从站时钟对齐到亚微秒级;CAN 无硬件同步,多关节高频同步更难,通常靠「广播帧 + 各节点本地定时」近似同步。

3.3 丢帧处理

• 检测:给每帧加递增序号/心跳计数,从站检测到序号跳变即丢帧,统计丢帧率。
• 短期丢帧:指令用「零阶保持」继续执行上一帧,或做一次线性外插,避免突然跳变。
• 连续丢帧/超时:超过阈值(如连续几十毫秒无新指令)必须降级保护——先减速到零、再抱闸刹车,不能「定格在最后一帧大力矩」。
• 根因:终端电阻缺失/重复、线缆过长、分支拓扑(非手拉手)、接地不良、ID 冲突、波特率不一致。

3.4 上电时序:先通信后使能

整机上电顺序必须遵守「先通信、后使能、再运动」,断电反序:

4 步态调参实战:参数清单、顺序与倒立摆直觉

关节都听话了,整机还不会走路——因为「走路」是全身动力学问题:迈步时质心会周期性跑出支撑多边形,机器人靠重力前倒,再用下一步的落点接住自己。步态调参就是调整一组高层参数,让这条「受控的不稳定」链条稳定运转。本节先给参数清单,再讲调参顺序,最后用倒立摆/ZMP 直觉解释「为什么调这个参数」。

4.1 从站立到行走的参数清单

4.2 调参顺序与判断标准

每一步的判断标准:站稳 → 站立 30s 不抖;原地转移 → 质心轨迹平滑无突跳;单腿支撑 → 不倾倒、支撑踝无明显高频抖;小步慢走 → 连续 5 步不拖地不后仰;逐步加快 → 每一步都先「能走稳」再「走更快」,出现任何异常立即回退上一组参数。

4.3 常见问题对应参数(排查表)

4.4 倒立摆 / ZMP 直觉:参数为什么这样影响

把机器人简化成线性倒立摆(LIPM):一根等长腿顶着一个质点(质心),质心高度恒定为 h,绕支撑点摆动。它的水平动力学极简:

从这两个式子能推出上面所有参数的作用:

• 重心高度 h ↓ → ω = √(g/h) 变小 → 倒立摆「发散更慢」→ 更稳,但屈膝力矩和能耗上升。这就是「蹲低点更稳但更累」。
• 前倾角 ↑ → 质心投影 x 前移 → 由 LIPM 方程产生向前的 ẍ → 机器前进;前倾过大,质心跑出支撑区前沿又来不及迈步,就前扑。前倾角本质是「持续给一个向前加速度」。
• 步幅 ↑ → 落点前移 → 支撑点前移 → 质心相对新支撑点的偏移与 ZMP 摆动幅度都变大 → 需要更大的踝力矩和更稳的平衡;步幅超过质心能「追上的范围」就摔。
• 步频 ↑ → 每步留给「质心前倒被接住」的时间变短 → 对控制器和执行层延迟更敏感,步频过快会「来不及反应」。
• 支撑期占比 ↑ → 双腿同时着地的时间长 → 支撑多边形更大 → 更接近静态稳定;占比降到 0.5 以下就进入「跑」,双支撑相消失,几乎全靠动态平衡。
• 抬脚高度 ↑ → 摆动腿离地时间长 → 单支撑期拉长 → 平衡难度上升,且落地速度更大 → 冲击更大。所以「抬脚够用即可」。

5 故障排查流程:六类故障决策树

调试中出问题,最忌「东试一下西试一下」。正确做法是按决策树从「最常见、最易测」的原因开始逐层排查。下表把六类高频故障的排查顺序压缩成树:

几个关键故障的深入排查

6 整机测试与验收:标定、温升、耐久与稳定性

调好之后还要「验收」,证明整机真的合格,而不是「今天碰巧能走」。下面给出四项最基础的验收测试。

行走稳定性的简单指标(没有专业动作捕捉时也能测):① 连续步数/时长——能连续走多少步不倒;② 直线偏差——走 1m 后横向偏移多少;③ 落地冲击——用足底或躯干加速度计测落地瞬间峰值 g 值;④ ZMP 裕度——若有关节力矩与足底力,可实时算 ZMP 距支撑多边形边界的最近距离,裕度越大越稳。这些指标不需要昂贵设备,却能量化「走得好不好」。

7 与 Hdrive 结合:调试记录模板与常见问题清单

把上面的流程落到你的 Hdrive 关节模组上,关键是「记录」——参数一多,不记录就等于白调。下面给一个可直接复制的调试记录模板,以及结合本项目硬件的常见问题清单。

7.1 关节调试记录模板

============================================================
关节调试记录
------------------------------------------------------------
关节ID:__________    位置:髋/膝/踝(L/R)    固件版本:__________
电机型号:__________  减速比:__________      编码器:__________
日期:__________      调试人:__________
------------------------------------------------------------
[电流环]  Kp=____  Ki=____  带宽约____Hz  振荡判定:有/无
[速度环]  Kp=____  Ki=____  上升时间____ms 超调____%
[位置环]  Kp=____  Ki=____  Kd=____ 静差____ 振荡:有/无
[谐振]    谐振频率 f_r=____Hz  陷波中心=____ 深度=____
[摩擦]    Fc=____  B=____  辨识速度点:________
[限幅]    电流限幅=____A  速度限幅=____  软限位=____
[温升]    环境____°C  绕组____°C  MOS____°C  @额定运行____min
[抱闸]    上电时序验证:通过/失败  掉电抱闸:通过/失败
[备注]    ________________________________________________
============================================================

7.2 Hdrive 常见问题清单

8 小结与思考

9 本节自测

10 参考来源

资料整理更新至 2026-08。下列来源经 web_search 核实,参数建议值中带「约」的为工程经验范围,请在实机上验证。

• Zero Moment Point(维基百科,Vukobratović 1968 概念出处)
• Next generation legged robot locomotion: A review on control techniques(ScienceDirect,足式运动控制综述)
• SimpleFOC 官方文档(本项目软件生态,含 PID 环、电流/速度/位置环配置)
• ODrive 官方文档(伺服整定、陷波、摩擦补偿等应用笔记)
• 伺服驱动系统调参实战:从 PID 参数整定到振动抑制的完整方法(工控网)
• 伺服驱动器调优实战:从参数整定到振动抑制的系统方法(工控网)
• 基于自适应陷波滤波器的伺服系统谐振频率估计及抑制(电机与控制应用)
• 谐波减速器的非线性摩擦建模及补偿(光学精密工程,万方)
• EtherCAT 从站伺服同步专利(EtherCAT 周期 125μs/1ms 与同步说明)
• 多设备 CAN 总线通信异常的故障排查(腾讯云开发者社区)
• Kajita 等,Biped Walking Pattern Generation by Using Preview Control of Zero-Moment Point,ICRA 2003(预览控制原文);Pratt 等,Capture Point: A Step toward Humanoid Push Recovery,Humanoids 2006(捕获点原文)——可经 Google Scholar 检索获取