[具身智能-798]：NAV2 底层速度指令执行层（ros_controller 动作执行层）超详细通俗详解 + 实战示例

一、层级定位

顶层全局规划：定远方路线、战略方向；中层局部规划：生成平滑轨迹、输出cmd_vel速度指令（线速度 + 角速度）；底层速度执行层：唯一执行单元，无任何决策权限只负责把上层下发的抽象速度指令，转换成机器人真实车轮转动，完成车体运动闭环控制，是导航落地的最后一环。

通俗定位：中层是发号施令的指挥员，底层是百分百服从命令的一线操作工。

二、核心输入与输出

输入

1. 上层话题/cmd_vel =》 按照此速度和角度行驶。
   • linear.x：前后前进速度
   • angular.z：原地 / 行进转向角速度
2. 本体传感器反馈
   • 轮式编码器：实际车轮转速、行走里程
   • IMU 惯性单元：车体姿态、俯仰横滚、实际偏航角
   • 底盘急停、限位、故障状态信号
3. 底盘运动学参数：轮距、轮径、最大转速、减速比

输出

1. 左右轮独立转速 / PWM 占空比 / 电机驱动电压
2. 向上反馈/odom里程计数据（实际走了多远、转了多少角度）
3. 硬件保护信号：过载堵转、过热、紧急停车

三、底层执行层三大核心工作

1. 运动学解算（指令拆分）

不同底盘，同一份速度指令，拆分成不同车轮动作

（1）差速两轮底盘（最常用）

公式逻辑人话版：

• 直线前进：左右车轮同速同向转动
• 原地转向：左右车轮同速反向转动
• 行进转弯：内侧轮慢、外侧轮快

把v(前进速度) + w(旋转速度)直接换算成左轮转速、右轮转速。

（2）全向麦轮底盘

把前后、左右、旋转三轴速度，拆解为四个车轮独立转速，实现横移、斜走。

（3）阿克曼小车

把速度指令拆分为前轮转向角度 +后轮驱动转速，符合汽车行驶逻辑。

本质：把统一的导航速度语言，翻译成底盘能听懂的车轮转速语言。

2. 闭环速度控制（PID 稳速核心）

上层只给目标速度，不管理实际走得准不准，稳速全靠底层闭环。

1. 拿到中层下发目标轮速
2. 读取编码器得到实际当前轮速
3. 对比差值：实际慢了就加大动力，实际快了就降低动力
4. 通过比例 + 积分 + 微分 PID平滑修正
5. 消除打滑、地面阻力、电池电压下降带来的速度偏差

通俗举例：电池没电动力变弱，上层指令不变，底层自动加大输出功率，保证行走速度不变。

3. 安全逻辑与动作限制

1. 软限位：超过最大转速直接限幅，不执行超速指令
2. 缓启停：速度渐变，禁止瞬间满速启动、瞬间骤停
3. 急停优先级最高：收到急停信号立刻切断动力，无视cmd_vel
4. 堵转保护：车轮卡死立刻降功率，保护电机与驱动器
5. 姿态保护：车体倾斜过大自动减速停车

四、底层执行层完整运行全流程

1. 持续监听中层发布的/cmd_vel速度指令
2. 依据自身底盘类型，完成运动学解算，分配各车轮目标转速
3. 读取编码器实时采集实际车轮转速
4. PID 闭环调节，修正转速偏差
5. 输出 PWM 驱动信号控制电机运转
6. 融合轮速 + IMU 数据，解算出自身位姿，发布里程计/odom回传给中层
7. 全程监测硬件状态，异常立即执行保护动作
8. 循环高频执行（50Hz~200Hz 硬实时）

五、底层执行层核心特点

1. 零决策、零规划不会改路线、不会避障、不会纠正导航偏差，指令是什么就执行什么。
2. 极致实时性全导航三层里运行频率最高，响应最快，保证运动无延迟。
3. 只负责精准执行，不负责逻辑判断导航跑偏、撞障碍、路线错误，全部和底层无关，属于上层问题。
4. 负责消除机械误差路面打滑、电机差异、电压波动等物理问题，全部由底层稳压稳速抵消。
5. 状态双向闭环向上反馈实际运动状态，形成「上层发指令 — 底层执行 — 底层反馈」完整闭环。

六、实战场景通俗示例

示例 1：直线匀速直行

1. 局部规划下发：前进速度 0.5m/s，转向速度 0
2. 底层解算：左右车轮同速转动
3. 行走中遇到地面摩擦力变大，车速轻微下降
4. PID 自动提高电机输出，拉回设定速度
5. 平稳保持直行，同步上报行走里程

示例 2：导航缓慢向右微调纠偏

1. 中层下发小幅右转角速度
2. 底层立刻执行：左轮略快、右轮略慢
3. 车体平缓右转，无突兀晃动
4. 纠偏完成，角速度归零，恢复直行

示例 3：前方遇障，中层下发减速停止指令

1. cmd_vel速度逐步下降
2. 底层不瞬间刹车，按照预设减速梯度缓慢降速
3. 平稳停车，杜绝急刹点头、货物倾倒
4. 等待新行走指令

示例 4：电池电压降低动力不足

1. 电机出力变小，实际车速低于目标车速
2. 底层 PID 检测到偏差，自动抬升输出占空比
3. 维持设定行走速度不变，使用者完全感受不到电量变化

示例 5：下发原地旋转指令

1. 中层输出纯旋转角速度
2. 底层直接控制两轮反向等速转动
3. 精准完成原地转向，转向角度依靠里程计实时回馈

示例 6：紧急避障急停

1. 安全层触发急停信号
2. 底层优先切断所有速度指令，立刻制动停车
3. 无论上层下发任何行走命令，全部暂时无效，保障硬件安全

七、底层执行层与上两层明确权责划分

1. 全局规划层管方向、管路径、管终点 → 走错路、目标错误归它
2. 局部规划层管轨迹、管避障、管快慢、管转向 → 躲不开障碍、行走抖动、调速不合理归它
3. 底层执行层管转速、管平稳、管精准落地、硬件保护 → 走不稳、速度忽快忽慢、电机抖动、启停生硬归它

故障快速判定口诀

• 整体路线跑偏：全局 / 中层问题
• 能规划不走、不动：底层无指令接收或驱动故障
• 指令正常，车子走得忽快忽慢：底层 PID 参数异常
• 转向指令下发，车体转向僵硬：底盘解算参数错误

八、底层执行层常见核心可调参数

1. 电机 PID 速度环参数：决定行走稳不稳
2. 加减速斜率：控制起步、停止顺滑程度
3. 最大轮速限制：物理限速保护
4. 编码器脉冲系数：修正行走里程精准度
5. 急停使能、堵转保护阈值
6. 行走死区：消除小指令车体不动的卡顿问题

九、一句话终极总结

NAV2 底层速度执行层，是整套自主导航系统手脚与肌肉，只接收运动命令、精准驱动机械运动、稳定消除物理误差、守护硬件安全，不折不扣完成上层所有行走动作，是智能导航从虚拟算法落地为实体运动的最后核心枢纽。