要确定震荡来自内环角速度环还是外环角度环,核心是利用“控制层级差异”——内环是“底层快速响应环”(直接驱动电机,控制角速度),外环是“上层精准控制环”(通过设定内环目标角速度,控制角度)。两者的震荡会因“控制对象(角速度vs角度)”和“响应速度”呈现不同特征;再结合“P/D参数的震荡本质”,可通过“震荡频率、触发场景、模式切换测试”三步定位问题来源。

一、先明确内环与外环的核心职责(理解差异的基础)

在无人机串级PID(角速度环+角度环)中,两层环的分工和响应速度完全不同,直接决定了震荡特征:

控制环控制对象响应速度输出指令核心作用
内环(角速度环)电机角速度(rad/s)快(10~50Hz)电机PWM舵量快速抵消角速度偏差(如抗风、手动转动)
外环(角度环)机身姿态角(°)慢(5~20Hz)内环的“目标角速度”精准控制角度(如保持水平、跟踪摇杆角度)

关键逻辑:内环是“执行层”,响应快,震荡更“直接、高频”;外环是“决策层”,响应慢,震荡更“间接、低频”,且依赖“角度偏差”触发。

二、核心判断方法:3步定位“内环/外环 + P/D参数”

步骤1:通过“震荡频率+幅度”初步划分“内环vs外环”

内环和外环的响应速度差异,导致震荡频率有明显分界;再结合P/D参数的震荡特征(低频大晃是P,高频小抖是D),可先缩小范围:

震荡类型大概率归属环可能参数(P/D)无人机实际现象示例
低频大晃(0.52秒/次,幅度±5°±15°)外环(角度环)P过大手动倾斜飞机后松手,飞机像“钟摆”一样缓慢来回摆(角度超调→反向摆→再超调)
低频中晃(0.31秒/次,幅度±3°±8°)内环(角速度环)P过大打舵给角速度指令后回中,飞机角速度超调→反向回摆(如横滚方向快速晃,但角度摆幅比外环小)
高频小抖(0.10.5秒/次,幅度±0.5°±2°)内环(角速度环)D过大悬停时机身快速“发抖”,电机发出“滋滋”高频异响(无明显角度摆幅,仅高频振动)
高频微抖(0.20.6秒/次,幅度±1°±3°)外环(角度环)D过大(罕见)角度微小变化时(如风吹),飞机高频颤振(但外环通常不用D,此情况极少)

关键结论

  • 若震荡是“低频大晃”,优先怀疑外环角度环P过大
  • 若震荡是“低频中晃”,优先怀疑内环角速度环P过大
  • 若震荡是“高频小抖”,90%以上是内环角速度环D过大(外环几乎不用D,因角度变化慢,D易放大噪声)。
步骤2:通过“触发场景”验证“内环vs外环”

不同环的震荡,需特定“偏差条件”触发(内环需“角速度偏差”,外环需“角度偏差”),通过人为制造偏差,观察震荡是否出现,可进一步验证:

触发操作若震荡加剧→归属环原理说明
操作1:手动转动机身(给角速度偏差)内环(角速度环)手动转动时,内环需快速抵消“角速度偏差”,若内环P/D过大,震荡会立即加剧(如转动机身后松手,快速来回晃)
操作2:手动倾斜飞机(给角度偏差)外环(角度环)手动倾斜时,外环需通过设定内环目标角速度来抵消“角度偏差”,若外环P过大,震荡会随角度偏差增大而加剧(如倾斜后松手,缓慢钟摆晃)
操作3:悬停时无任何操作(仅传感器噪声)内环(角速度环)无操作时无角度偏差,外环输出稳定;若震荡仍存在,说明是内环D过大(放大了IMU/光流的噪声)

示例

  • 手动转动机身(给角速度)后,震荡加剧→内环问题;
  • 手动倾斜飞机(给角度)后,震荡加剧→外环问题;
  • 悬停无操作仍发抖→内环D过大。
步骤3:通过“飞控模式切换”锁定“内环vs外环”

多数飞控支持“不同控制模式”(如“手动模式”“姿态模式”“定点模式”),不同模式下“外环是否工作”不同,通过切换模式观察震荡是否消失,可直接锁定:

飞控模式外环(角度环)是否工作内环(角速度环)是否工作震荡变化判断
1. 手动模式(Manual)不工作(无角度闭环)工作(角速度闭环)若震荡消失→外环问题;若震荡仍存在→内环问题
2. 姿态模式(Stabilize)工作(角度闭环)工作(角速度闭环)若震荡存在,切换到手动模式后消失→外环问题
3. 定点模式(Loiter)工作(角度+位置闭环)工作(角速度闭环)若震荡比姿态模式更明显→可能叠加了位置环,但核心仍先判断角度环vs角速度环

原理:手动模式下,飞控仅通过内环角速度环维持“当前角速度”(无角度闭环),若震荡在手动模式下消失,说明震荡来自“外环角度环”(因外环不工作了);若震荡仍在,说明来自“内环角速度环”(内环始终工作)。

三、实战排查案例(结合具体场景)

通过一个实际案例,演示完整判断流程:

案例现象:无人机悬停时,机身以1秒/次的频率左右慢晃(幅度±8°),无高频抖。
  1. 步骤1:频率+幅度初步判断:低频大晃(1秒/次,幅度8°)→ 怀疑外环角度环P过大;
  2. 步骤2:触发场景验证
    • 手动倾斜飞机(给角度偏差)后,晃幅增大到±12°→ 震荡随角度偏差加剧,符合外环特征;
    • 手动转动机身(给角速度偏差)后,晃幅无明显变化→ 排除内环;
  3. 步骤3:模式切换验证
    • 切换到手动模式(外环不工作)→ 慢晃立即消失;
    • 切回姿态模式(外环工作)→ 慢晃再次出现;
  4. 结论:外环角度环P过大→ 减小外环角度环P参数(如从2.0减到1.5),慢晃消失。

四、常见误区与避坑指南

  1. 不要混淆“内环P过大”和“外环P过大”
    两者都是低频晃,但外环晃幅更大、周期更长(因角度环响应慢),且手动倾斜时更明显;内环晃幅小、周期稍短,手动转动时更明显。
  2. 外环几乎不用D参数,无需优先怀疑外环D
    角度变化慢,D参数易放大“角度测量噪声”(如IMU角度漂移),多数飞控默认外环D=0,若出现高频抖,优先查内环D,而非外环。
  3. 先排除硬件问题,再判断参数
    若电机虚位、IMU减震不良、螺旋桨不平衡,也会导致类似“参数震荡”的现象(如电机异响、机身抖动),可先通过“断开电机线,手转电机看是否顺滑”“检查IMU减震棉是否老化”排除硬件问题。

总结:判断流程口诀

  1. 先看频率定范围:低频大晃外环P,低频中晃内环P,高频小抖内环D;
  2. 再用触发验归属:手动转体加内环,手动倾斜加外环,无操仍抖是内环D;
  3. 最后模式锁结论:手动模式震消失→外环,震仍在→内环。

通过这套流程,可快速定位震荡来自内环还是外环,以及具体是P还是D参数,避免盲目调试,提高调参效率。

Logo

北京人形旗下天工造物具身智能开源社区,聚焦具身天工与慧思开物两大平台

更多推荐