1. 课程导论：为什么需要协同优化？导航与运动控制的耦合关系解析
大家好，我是你们这门课的主讲。在正式开始之前，我想先问一个问题：你调过导航参数吗？
如果你调过，你一定遇到过这种情况——明明全局路径规划得挺好，机器人走起来却像喝醉了酒，左右摇摆，或者干脆卡在墙角出不来。这时候你可能会怀疑是导航参数没调好，于是去调代价地图的膨胀半径、路径规划的权重。折腾半天，发现还是不行。
嗯，问题可能不在导航本身。
1.1 一个真实的“坑”
我记得几年前做的一个仓储机器人项目。当时我们用的是一套很成熟的导航框架，全局路径规划用的是A*，局部规划用的是DWA。按理说，这套组合在业内已经验证过无数次了，不会出大问题。
但实际跑起来，机器人就是走不直。
每次转弯都会 overshoot，然后来回修正。我们团队花了两周时间调导航参数——膨胀半径、路径平滑度、规划频率，能调的都调了。效果有改善，但始终达不到要求。
后来我实在没办法，去看了运动控制的底层日志。结果发现，电机响应延迟比我们预想的大了将近100ms。导航系统以为机器人已经转到目标角度了，但实际上电机还在转。导航系统看到偏差，又发新的修正指令。一来二去，机器人就“抽风”了。
这就是典型的导航与运动控制脱节的问题。
核心观点：导航系统做的是“决策”，运动控制系统做的是“执行”。如果执行跟不上决策，或者决策不了解执行的能力边界，整个系统就会出问题。
1.2 导航与运动控制的耦合关系
说白了，导航和运动控制不是两个独立的模块。它们之间有一条双向数据通道。
- 导航→运动控制：下发速度指令（线速度、角速度）、目标位姿、路径点序列。
- 运动控制→导航：反馈实际速度、里程计数据、执行状态（是否到位、是否打滑）。
你想想看，如果这条通道上的信息是“失真”的，会发生什么？
导航系统以为机器人能跑1m/s，但实际电机只能跑到0.8m/s。导航规划了一条急转弯路径，但运动控制的最小转弯半径根本做不到。这些不匹配，最终都会表现为路径跟踪误差。
我个人的习惯是，把这种耦合关系画成一张图，这样更容易理解。
1.3 为什么不能分开调？
很多团队的开发流程是这样的：先调运动控制，让机器人能走直线、能转弯。然后调导航，让机器人能规划路径、能避障。最后把两个模块拼起来。
这种做法，我称之为“串行调试”。它的问题在于：
| 调试方式 | 典型做法 | 结果 |
|---|---|---|
| 串行调试 | 先调运动控制，再调导航 | 运动控制参数在导航场景下可能不适用 |
| 独立调试 | 两个团队各自调各自的 | 接口不匹配，联调时大量返工 |
| 协同优化 | 统一考虑导航与运动控制的约束 | 系统整体性能最优，调试效率高 |
我曾经在一个项目里吃过这个亏。当时运动控制团队把PID调得特别“硬”，响应很快，但代价是会有轻微的超调。单独测试运动控制时，这个超调完全在可接受范围内。但一接到导航系统上，问题就来了——导航的局部规划器每次检测到超调，就认为路径偏离了，立刻重新规划。结果机器人每走一步，导航都在重新规划，CPU占用率飙升，机器人反而走得更慢了。
这就是典型的“局部最优，全局不优”。
避坑指南：千万不要把运动控制调到“完美”再开始调导航。运动控制的“完美”是在空载、匀速、直线条件下的。导航场景下，机器人要变速、转弯、加减速，运动控制的动态特性完全不同。我曾经见过一个团队，运动控制调了两个月，导航调了三个月，最后发现运动控制的加速度限制设得太高，导航规划的路径根本执行不了。全部重来。
1.4 协同优化的核心思想
那什么是协同优化？说白了，就是把导航和运动控制当成一个整体来考虑。
具体来说，有几点：
- 参数共享：运动控制的最大速度、最大加速度、最小转弯半径，要作为导航规划的硬约束。导航规划出来的轨迹，运动控制必须能执行。
- 反馈闭环：运动控制的执行误差要实时反馈给导航系统。导航系统不能假设“指令发了就等于执行了”。
- 联合调试：调参时，同时观察导航的规划质量和运动控制的跟踪误差。找到一个平衡点。
我个人的习惯是，在项目初期就建立一个联合仿真环境。导航和运动控制都在这个环境里跑，参数可以实时调整。这样能快速发现不匹配的地方，而不是等到真机联调时才暴露问题。
小技巧：在联合仿真时，可以故意给运动控制加一些延迟和噪声，模拟真实电机的特性。这样调出来的导航参数，在真机上往往表现更好。我试过很多次，这个做法能省掉至少30%的现场调试时间。
1.5 本章小结
这一章我们聊了为什么导航和运动控制需要协同优化。核心就一句话：导航做决策，运动控制做执行，两者必须匹配。
后面的课程里，我们会深入讲解具体的协同优化方法。包括怎么分析运动控制的动态特性、怎么把运动控制约束融入导航规划、怎么设计联合调试流程。这些都是我多年项目经验的总结，希望能帮你少走弯路。
嗯，今天就到这里。记住，下次调参的时候，别只盯着导航参数看。去运动控制那边也瞅一眼，说不定问题就解决了。