有段时间我一直在折腾一台中型四轴，拿到手之后最明显的问题是：飞控切到位置模式，往前推杆让它飞出去，到达目标点之后机头会轻轻点一下，机身前后晃两三次才稳住。这个现象不致命，却很影响手感，也让我下定决心把PX4里位置环、速度环这两个模块彻底啃了一遍。说实话，网上讲PX4姿态控制、角速率控制的文章很多，但真正把外环这两个环讲透、讲到能指导调参和排查问题的，很少。这篇就当作我实战系列第十二期的内容，把位置环和速度环的模块结构、信号链路、参数逻辑和排错思路一次说清楚。

这篇内容适合正在用PX4做二次开发或者调试多旋翼的朋友，尤其是当你发现飞机“到点刹不住”、悬停慢漂、offboard跟踪指令发飘的时候，大概率问题就出在位置环或速度环，而不是姿态环。读完你应该能回答三个问题：这两个环分别在哪段代码里干活、它们各自输出什么、出故障时怎么从日志里反推根因。

1. 先看清全貌：位置环和速度环在整条控制链路中的位置

1.1 一次起飞中，各个控制器到底按什么顺序干活

先从“一次正常飞行”说起，这样能直观理解控制链路的顺序。你在地面站点击起飞，或者手动推油门让飞机离地，飞控内部每个控制周期里大致会经历这样一个流水线：先看“我要去哪”，再看“我在哪”，然后算“差多少”，再把差值换算成指令一级一级往下传。

具体到PX4多旋翼，完整链路是这样的：期望轨迹（可以是航线点、offboard下发的坐标或者摇杆映射出的期望速度）先进入位置环；位置环比较期望位置和当前估计位置，输出一个期望速度；这个期望速度再送给速度环；速度环比较期望速度和当前估计速度，输出期望加速度；期望加速度会转化为期望倾斜角，砸给姿态环；姿态环比较期望姿态和当前姿态，输出期望角速率；角速率环比较期望角速率和当前角速率，输出期望力矩；力矩最后进混控器，变成四个电机的转速指令。

也就是说，位置环和速度环通常被合在一起称为“外环”，而姿态环加角速率环是“内环”。外环解决的是“飞机在空间里怎么移动”的问题，内环解决的是“飞机朝哪边倾斜、转多快”的问题。两者各自独立又级联在一起，位置环的输出恰好是速度环的输入，速度环的输出又恰好是姿态环的期望值，一环扣一环。

1.2 为什么不直接把位置误差换算成倾斜角，非要三级嵌套

这是大家刚接触时最容易困惑的点。直觉上，位置偏了1米，我把飞机往目标方向倾斜个5度不就行了吗？为什么还要先算速度、再算加速度、再转成姿态角，绕一大圈？

关键在于干扰和惯性。飞机在空中受到风、重心偏移、螺旋桨振动各种扰动，姿态角的变化并不能直接且精确地换算成位置变化。中间的倾斜角只是一个手段，最终目标永远是把位置和速度同时拉回期望值。如果把位置误差直接映射到姿态角，遇到一阵横风，姿态为了修正位置会做剧烈摆动，位置却因为机体惯性跟不上，两者就会打架，飞机会“点头”或者“甩尾”。

所以PX4采用级联控制：每个环只负责一个物理量的调节，内环跑得快，负责抵抗快速扰动和稳定姿态；外环跑得慢，负责修正位置误差，给内环提供合理的期望信号。这种带宽分离的做法，也让每一级都能独立调参——速度环不稳了不用去翻姿态环参数，姿态环抖了也不用动外环。理解这一点，后面所有调参和排查都能顺下来。

2. mc_pos_control内部拆解：位置环速度环到底写在哪些代码里

2.1 模块入口与主循环：250Hz的控制周期是怎么攒出来的

在常见PX4版本中，位置环和速度环实现在src/modules/mc_pos_control这个模块里，模块主体是一个独立的任务，通过uORB消息和姿态环、位置估计模块通信。它的主循环会先等一批“输入”到齐才启动计算：当前本地位置估计、当前速度估计、当前姿态四元数、期望位置/速度设定值、飞行模式开关量等。

主循环按照固定的控制周期执行，常见配置下是250Hz，也就是4毫秒跑一次完整的外环计算。之所以选择这个频率，是因为外环面对的物理量（位置和速度）变化相对慢，4毫秒的周期已经足够平滑，同时又比多数桨叶的振动频率低很多，能天然避开一部分高频噪声。如果你去改这个循环周期，会发现控制效果不是线性变好——跑太快反而容易把传感器的微小抖动当成速度误差放大，跑太慢则位置跟踪会显得黏滞。

整个模块跑完后会发布两类关键输出：一类是期望加速度和期望推力方向，用于给姿态环做设定；另一类是垂直方向的油门期望值。水平位置控制和垂直高度控制在同一个模块里并行处理，只是它们对应的控制律和输出接口不一样，这也是为什么下文要分开讲。

2.2 位置环（外环）：为什么一个P控制就够用

先看水平位置环，它的代码逻辑很朴素：取当前位置与期望位置的误差，乘以一个位置增益，得到期望速度，再把外部给定的速度前馈叠加进去。写出来就是：

期望速度 = MPC_XY_P * 位置误差 + 期望速度前馈

这里MPC_XY_P的单位是1/s，物理含义很直白：每米位置误差产生每秒多少米的修正速度。如果位置误差是2米，MPC_XY_P为1.0，那期望速度就是2米/秒，飞机以2米/秒的速度往回飞。

为什么位置环不用PID全套？我最早也怀疑过，后来想明白了：在这个级联结构里，位置环的“积分”功能实际上被速度环的积分替代了，位置误差持续存在，最终会反映到速度环积分项上，不需要位置环自己再攒一个积分项。而微分项在位置环里很容易放大传感器噪声，并且会让飞机在接近目标点时过早减速，出现“到不了点”的黏滞感。所以单P加前馈是工程上最稳的组合，不是开发人员偷懒。

需要注意的是，位置环算出来的期望速度会经过限幅，这个限幅值通常由MPC_XY_CRUISE（最大巡航速度）决定。如果飞机离目标点很远，位置误差很大，期望速度也会被钳在巡航速度上，飞机用恒定速度飞过去。这就是为什么航线飞行时，即使误差再大，飞机也不会越来越快直至失控。

2.3 速度环（内环）：PID、加速度前馈、限幅与倾斜角转换

位置环算出期望速度之后，代码接着进入速度环。速度环的标准形式是PID加前馈：

期望加速度 = MPC_XY_VEL_P * 速度误差 + MPC_XY_VEL_I * 速度误差积分 + MPC_XY_VEL_D * 速度误差微分 + 期望加速度前馈

其中速度误差就是期望速度减去当前估计速度。用力学的语言讲，加速度误差本质上是“为了改变当前速度，需要产生多大的加速度”。有了期望加速度，再把重力向量考虑进去，就能算出机体为了产生这个水平加速度需要倾斜多大的角度，然后把这个倾斜角作为期望姿态发送给内环。

这里的排序有讲究。位置环的期望速度是“慢变量”，速度环的期望加速度是“快变量”，但无论如何，加速度不能无限大，否则飞机倾角会过大甚至翻过去。所以速度环输出有过几层限幅：最大水平加速度限幅（控制飞机加减速的猛烈程度）、最大倾斜角限幅（MPC_TILTMAX_AIR，控制飞机最大倾斜角度）。形象点说，位置环告诉你“该往哪走”，速度环告诉你“用力多大”，限幅则保证这一脚油门踩下去不会把车开翻。

垂直方向的控制逻辑类似，只是多了一个高度外环：高度环把高度误差转换成期望垂直速度，垂直速度环再把垂直速度误差换算成期望油门（也就是推力）。这两个小块也在mc_pos_control模块内，只不过垂直速度环使用的是油门输出而非倾斜角，所以调参参数是另一组。除非你做的是农业无人机或者载重平台，否则默认参数一般不用动垂直方向。

3. 模式切换时，位置环速度环各自的路由与旁路逻辑

3.1 Position / Altitude / Stabilized / Offboard：哪些环在工作

PX4支持多种飞行模式，不同模式下外环并不是一直都在跑。这里用一张表把常见模式下的“环路接线”情况列出来，理解这张表，基本上就能看懂为什么某些模式飞机很“跟手”，某些模式却需要你自己稳住姿态。

定高模式是一个特别典型的“部分旁路”场景。它只锁定高度，水平方向完全由操作者通过姿态角来控制。所以定高模式下位置环和水平速度环都不计算，高度环和垂直速度环正常工作。如果你在定高模式下发现飞机“稳不住高度却不漂”，那问题大概率出在垂直速度环，而不是水平方向。

Position模式则会把外环全链路跑起来，摇杆给出的实际上是期望速度，位置环负责在摇杆回中时把飞机稳在当前点上。Offboard更灵活，外部可以通过MAVLink直接下发速度设定值或者位置设定值，下发速度设定值时位置环被旁路但速度环仍然参与，下发位置设定值时两个外环都在工作。

3.2 起飞、降落与过渡阶段：位置环速度环的特殊照顾

除了模式切换，飞行阶段也会影响外环行为。以起飞为例，飞控不会让位置环在飞机还没离地时就把期望速度输出成一大坨，因为机轮/脚架还撑着飞机，位置误差根本没法通过倾斜角来修正。在起飞阶段，期望位置、期望速度都会被限制在一个可信范围内，等检测到机体已经离地、垂直速度超过阈值，位置环才会逐步放开限制。

降落阶段同理。接近地面时速度环的输出会被收紧，水平期望速度被压低，垂直速度也会按照预设的降落速率下滑，避免飞机在触地瞬间还带着较大的水平速度往前搓。最容易踩的坑是着陆后忘记切模式，飞机还停留在位置模式，它检测到位置误差后仍然试图修正位置，结果在地面上“蹭”着走。这种情况不是位置环坏了，而是模式没有随状态切换。

我见过不少开发者在这块翻过车：用offboard做自主起降，起飞和降落阶段的外环设定值没有做阶段处理，导致飞机在离地瞬间有个猛冲的动作。实际上只要在起飞阶段只给垂直速度设定、不给水平位置设定，等离地后再切完整的期望位置控制，这个问题就消失了。简单说，外环跑得再漂亮，也要看是谁在给外环喂设定值。

4. 调参不要上来就抄：从增益单位看懂每个参数

4.1 从物理意义理解MPC_XY_P、MPC_XY_VEL_P和MPC_XY_VEL_I

PX4位置环、速度环最常用的几个调参参数，网上都能搜到默认值，但很少有人讲它们背后的物理含义。我建议在动参数之前，先把单位和数据流理清楚，否则你只是在试运气。

• MPC_XY_P：位置环P增益，单位1/s。频率越高，位置误差转化为期望速度的比例越大。调大它，飞机回中速度更快，但过大时会在目标点附近来回冲。
• MPC_XY_VEL_P：速度环P增益，单位1/s。它决定每米/秒的速度误差产生多大加速度。增大它，速度修正更快，但过大时飞机会出现高频振颤，电机声音会变得尖锐。
• MPC_XY_VEL_I：速度环积分增益，单位1/s²。它负责消除持续的稳态误差，比如受风或者重心偏移导致的持续漂移。积分太大会引发缓慢的周期摆动。
• MPC_XY_VEL_D：速度环微分增益。理论上它能提前抑制速度变化，实际上一旦机体振动稍大，微分项就会放大噪声，绝大多数场景下我建议把D项设为0，靠前后馈和P项就够了。

举个例子，MPC_XY_P从默认的1.8调到2.5，很多人会觉得“位置环更强了，飞机应该更跟手”，实际上只改了位置误差到期望速度的比例。如果你的速度环跟不上这个期望速度，飞机反而会过冲。这就像你给一个本来跑不快的引擎换了更大的油门踏板行程，结果不是车更快，而是轮胎狂打滑。

4.2 标准调参顺序：为什么必须从内往外调

外环依赖内环执行指令，所以调参铁律是：先角速率环，再姿态环，再速度环，最后位置环。内环不稳定，外环调得再完美也没有意义，甚至会出现“位置看着还行，但姿态在疯狂抖动”的假象。

我实际调试时的顺序是这样的：先在自稳模式下调角速率环，观察打杆响应和回中情况；然后切定高模式，调姿态环；接着切Position模式，把速度环P和I一点点加上去，在空旷场地做加减速往复测试；最后才动位置环P。每一个环节都要用日志或者飞控状态页面观察实际曲线，而不是只看手感。

下表是高频现象和参数的对应关系，可以直接存下来当参考：

4.3 前馈与限幅的配合：为什么有时候调增益不如调限幅

很多人忽略了限幅参数对控制效果的影响。我遇到过飞机到达目标点时严重过冲，一开始怀疑速度环P太小，加了P之后过冲确实变小，但飞行中高频抖动又来了。后来查日志发现，期望加速度已经经常顶到限幅值上，速度环P再大也白搭，反而是把减速加速度限幅调低一点，过冲立刻改善，整机还更安静。

这说明一个道理：外环的“性格”不只看增益，还要看限幅。增益决定小误差时的细腻程度，限幅决定大误差时的猛烈程度。比如希望飞机快速跟随航线但到点不冲，可以把MPC_XY_CRUISE设高一点，同时把水平加速度限幅设得略低，这样飞过去的途中速度快，接近目标时刹车就柔和。限幅参数是有物理边界的，调之前先问自己一个问题：这台飞机在某个速度下用最大倾角减速，刹车距离是否足够？不够的话，再猛的位置环也不可避免会过冲。

5. 信号链路与期望值平滑：摇杆、航线与offboard的融合方式

5.1 期望值从哪里来，又怎么进的位置环

位置环和速度环只负责“算”，它们不关心期望值到底来自哪里。PX4有一套完整的状态机来生成期望位置/速度设定值：手动位置模式下，摇杆的偏移量会经过一个速度映射曲线，变成期望速度设定值；如果摇杆回中，就会自动启用位置保持，期望位置锁定在当前位置上。航线飞行时，航线点管理器会输出下一段航线的期望位置和期望速度。

重点在于，这些期望值进入位置环/速度环之前一般会经过平滑和限速处理。因为摇杆瞬间打满或者航线切换产生跳变，如果不做平滑，位置环会瞬间看到一个很大的位置误差，速度环也会瞬间收到一个巨大的速度误差，机身就会出现明显的猛冲或者点头。PX4里这种平滑有时通过期望速度的速率限制完成，有些版本还会做加速度加加速度限制。如果你做offboard时自己下发期望速度，务必记得在外部也做同样的平滑，否则即使位置环参数完全正确，飞机也会看起来很“毛糙”。

5.2 速度前馈的真正价值，以及Offboard场景为什么特别敏感

前馈在位置环和速度环里都以“期望速度前馈/期望加速度前馈”的形式出现。有没有前馈，区别在于：纯反馈是看到误差才动作，前馈是提前知道目标在移动，先给出对应的输出，误差自然而然就小了。

拿offboard跟踪一个移动目标来举例。如果目标轨迹以5米/秒的速度移动，你只给位置环期望位置，位置环必须等真实位置落后目标一段距离之后，才能靠位置误差产生出每秒5米的期望速度。这一段滞后会始终存在，表现为“追着跑但永远差一截”。如果offboard同时下发期望速度5米/秒作为位置环前馈，位置环立刻把期望速度设定为5米/秒，就省掉了等待误差累积的过程，跟踪精度显著提高。

所以我的建议是：只要做offboard，优先采用位置+速度同时下发的模式；如果只下发位置设定值，一定要在外部自己算一个期望速度前馈。很多开发者觉得offboard模式“飘”，追不上目标，实际上不是PX4控制算法烂，而是设定值链路本身少了前馈那一环。速度环同理，如果上位机能够算出期望加速度，也把它作为前馈发给速度环，这样飞机在转弯和加减速时会更平顺，内环压力也小很多。

5.3 滤波与估计值对速度环的影响

速度环的输入之一是当前速度估计值，而这个估计值来自位置估计模块融合加速度计、GPS或者光流后的结果。如果传感器振动大或者滤波不恰当，估计出的速度就会带噪声，速度环的微分项和前馈项就会把这些噪声放大，最终表现为电机高频颤动。

排查这类问题，我通常看一眼控制量输出曲线和速度估计曲线：如果速度估计上有一堆毛刺，而控制量上也有一模一样的毛刺，说明噪声是从传感器侧灌进来的。这时不用急着调速度环增益，先把机架减振和滤波配置整理好再说。有一次我调某台四轴，速度环D项已经降成0了，飞机还是高频抖，最后发现是飞控减振棉装反了，加速度计在剧烈振动源上。硬件问题比软件问题更难找，但它往往藏在滤波和噪声的细节里。

6. 一次实际位置震荡的排查复盘：从现象到根因的完整链路

6.1 现象：飞机到点后“刹车点头”但悬停尚可

回到文章开头说的那台中型四轴，它的症状很清晰：水平飞行速度不低，切换目标点或者快速往前飞然后停稳的时候，机头明显向下点一下，伴随一两下纵向摆动；但悬停状态非常稳，没有慢漂，也没有高频抖。姿态环在这个平台上一直表现正常，自稳模式下手感也很好。

这类现象其实很有代表性，它说明问题多半不在内环，而在外环的速度规划和减速逻辑。悬停稳说明位置环速度环在小误差区域工作正常，而“刹车点头”通常发生在大误差、大速度减速的过程中。通俗地讲，飞机从高速往前飞的状态突然收到“停在这里”的指令，速度环拼命减速，期望加速度顶到限幅值，机身为了产生这个减速度需要抬头，但因为机身前倾过大，水平减速的同时也在损失升力，于是机头先下沉一下，整体高度也跟着掉一点点。

6.2 日志定位：在Flight Review里找三个信号

排查这类问题，我最依赖的工具是飞行日志回放页面，重点看三个信号线：期望位置与实际位置的偏差、期望速度与实际速度的偏差、期望加速度是否经常“撞墙”。

实测日志显示，这个平台在刹车阶段，期望加速度确实频繁触及水平加速度限幅值。与此同时，期望速度从巡航速度快速降到0，速度误差一大，速度环P项输出立刻饱和。这里的关键判断点就是：当速度误差大且加速度输出已经饱和时，再增加速度环P也不会让刹车更快，只会让饱和期间的微分项带来新的抖动。因此初始的调参方向应该放在“减速目标”和“减速限幅”上，而不是盲目加大速度环增益。

6.3 根因、修改与验证：参数可以改，但更值得改的是限幅

随后我把减速加速度限幅往下调了一些，同时也微降了最大巡航速度，让刹车阶段的加速度需求落在速度环的有效输出范围内。重新试飞后，刹车点头幅度明显减轻，机身只会有一声轻微的“嗯”就稳定下来，不再来回荡。

为了确保不是靠降性能换稳定，我又把位置环P微调回去一点，确认小偏差区域的响应速度没有退化。结果很有意思：整体飞行体验反而更好了，原因很简单——以前的“跟手”其实是大增益加饱和限幅带来的错觉，飞机动作猛但不精细；现在限幅合理，速度环始终工作在非饱和区间，控制量干净得多，姿态环接收到的期望倾斜角也更平滑。

6.4 这一类问题通用的排查顺序

这次排查之后，我整理了一个通用思路，送给同样被外环问题困扰的开发者：先看日志里速度环输出是否常驻限幅，是则先调限幅；再看速度环期望值与实际值之间的跟随情况，若跟不上，调速度环P和I；两者都正常却仍然过冲，再动位置环P。最后才是去怀疑滤波、振动和硬件减振。

我个人的做法是先让飞机在offboard模式下用指令速度画大矩形来回飞，同时记录巡航速度变化时的刹车行为。这一步能快速暴露减速限幅和速度环增益是否匹配。等你把这一段跑顺了，再回到位置保持和航线模式验证，位置环的问题通常会少很多。外环调试是一个逐级收敛的过程，跳级调参只会让飞机看起来“哪里都不对”，实际上每一层都还说得过去。

这轮折腾完之后，我对PX4外环的理解比之前深了一截。它本质上不是什么玄学，就是一层层带宽分离的物理量换算：位置环管方向，速度环管力度，限幅管边界，前馈管预测。下次再遇到飞机“不听话”，先别急着怀疑固件，打开日志看一眼你的位置环和速度环各自在哪个环节掉了链子，往往答案就写在信号曲线里。