3、轨迹规划基本概念：路径与轨迹的区别、运动学约束、动力学约束
各位工程师朋友，咱们今天聊点实在的。轨迹规划这个词，听起来挺唬人，但说白了，就是让机器怎么动起来、动得漂亮、动得安全。我刚开始接触运动控制那会儿，也把“路径”和“轨迹”混着用，结果调试时出了大问题。嗯，今天咱们就把这几个核心概念掰扯清楚。
3.1 路径与轨迹：一字之差，天壤之别
先问大家一个问题：你让机器人从A点走到B点，中间绕过障碍物。你告诉它“走这条线”，这叫路径。但你告诉它“走这条线，并且每秒钟走多少毫米，加速度不能超过多少”，这叫轨迹。
路径（Path），说白了就是空间中的一条几何曲线。它只关心“走哪条路”，不关心“怎么走”。比如直线、圆弧、样条曲线，这些都是路径的描述。路径是纯几何的，没有时间概念。
轨迹（Trajectory），则是路径加上时间信息。它告诉你：什么时刻，运动到哪个位置，速度是多少，加速度是多少。轨迹是路径的“时间化”版本。
我举个例子你就明白了。你开车从家到公司，导航给你规划了一条路线——这是路径。但导航还会告诉你“前方限速60，预计30分钟到达”——这就是轨迹了。路径是“空间”的事，轨迹是“时空”的事。
核心区别总结：
- 路径：几何描述，无时间属性。例如：从(0,0)到(100,100)的直线。
- 轨迹：时间+路径，包含位置、速度、加速度的时间序列。例如：t=0时在(0,0)，t=5s时在(100,100)，中间按梯形速度曲线运动。
我在项目中遇到过一位同事，他写插补程序时只算了路径点，没考虑速度规划。结果电机跑起来一顿一顿的，像得了帕金森。后来我帮他加上S型速度曲线，运动立马丝滑了。你看，这就是路径和轨迹没分清的后果。
3.2 运动学约束：别让电机“闪了腰”
轨迹规划不是你想怎么规划就怎么规划的。你得听电机的“脾气”。运动学约束，就是电机在运动层面上的“物理极限”。
常见的运动学约束有这些：
| 约束类型 | 符号 | 说明 | 典型值（举例） |
|---|---|---|---|
| 最大速度 | Vmax | 电机能跑多快 | 3000 rpm 或 1 m/s |
| 最大加速度 | Amax | 电机加速能有多猛 | 10 m/s² |
| 最大加加速度 | Jmax | 加速度的变化率，影响冲击 | 100 m/s³ |
你想想看，如果轨迹规划出来的速度超过了电机的额定转速，那电机就会丢步、过载，甚至烧毁。加速度太大呢？机械结构会震动，工件会飞出去。加加速度太大呢？嗯，这个更隐蔽——它会引起冲击，让机器寿命大打折扣。
我曾经调试一台高速贴片机，轨迹规划时只限制了速度和加速度，没管加加速度。结果机器跑起来后，虽然速度曲线看着挺平滑，但每到加减速的拐点，机器就“咯噔”一下。后来加上加加速度约束，把冲击力降下来，机器才真正安静了。
我的经验：运动学约束的优先级是：加加速度 > 加速度 > 速度。先保证不冲击，再保证不震动，最后才考虑跑多快。顺序搞反了，后面调试会非常痛苦。
3.3 动力学约束：别让电机“累趴下”
运动学约束管的是“能不能做到”，动力学约束管的是“能不能承受”。说白了，运动学看的是电机的能力，动力学看的是系统的负载。
动力学约束的核心是力矩（或力）。电机能输出多大的力矩？负载的惯量有多大？摩擦力有多大？这些都会影响轨迹规划。
常见的动力学约束包括：
- 最大力矩/力：电机能输出的峰值力矩，不能超过这个值，否则电机过载。
- 连续力矩：电机长时间运行能承受的力矩，超过会发热烧毁。
- 惯量比：负载惯量与电机转子惯量的比值。比值太大，系统响应慢，容易震荡。
- 摩擦力：静摩擦、库仑摩擦、粘性摩擦，这些都会消耗力矩。
我给大家画个图，看看运动学约束和动力学约束在轨迹规划中的位置关系：
你看这个图就清楚了。轨迹规划器生成初步的轨迹后，要经过运动学约束和动力学约束的双重检查。运动学约束管的是“能不能跑这么快”，动力学约束管的是“电机有没有力气跑”。两者都通过了，才能输出最终的轨迹。
注意：很多工程师只关注运动学约束，忽略了动力学约束。结果就是：轨迹规划出来的速度、加速度都在电机规格内，但实际运行时电机力矩不够，导致跟踪误差大、甚至过载报警。我建议你在做轨迹规划时，至少做一个简单的动力学模型，估算一下需要的力矩。
3.4 实际项目中的约束处理顺序
说了这么多理论，咱们聊聊实际怎么干。我在做轨迹规划时，一般按这个顺序处理约束：
- 先确定路径：根据工艺要求，规划出几何路径（直线、圆弧、样条等）。
- 再查运动学约束：根据电机和驱动器的规格，设定Vmax、Amax、Jmax。这是硬约束，不能超。
- 再算动力学约束：根据负载惯量、摩擦力、重力等，估算需要的力矩。如果力矩超了，要么降低加速度，要么换更大的电机。
- 最后做速度规划：在满足所有约束的前提下，生成S型曲线或梯形曲线。
嗯，这里要注意：动力学约束往往比运动学约束更严格。比如一个电机额定加速度是10m/s²，但负载惯量很大，实际能用的加速度可能只有3m/s²。你如果按10m/s²去规划轨迹，电机就会“累趴下”。
避坑指南：我曾经在调试一台龙门架时，按电机手册上的参数做了轨迹规划，结果一跑就报“跟踪误差超限”。查了半天才发现，负载惯量是电机惯量的20倍，实际能用的加速度只有理论值的1/5。后来我养成了一个习惯：做轨迹规划前，先算一下惯量比。如果惯量比超过10，就要小心了。
3.5 小结
今天咱们聊了三个核心概念：路径与轨迹的区别、运动学约束、动力学约束。说白了，路径是“路”，轨迹是“怎么走”。运动学约束管的是“能不能走这么快”，动力学约束管的是“有没有力气走”。
做轨迹规划时，千万别只盯着速度曲线看。把运动学和动力学约束都考虑进去，你的机器才能跑得又快又稳又安全。下次咱们聊具体的速度规划算法，梯形曲线和S型曲线怎么选，到时候再细说。
公众号:蓝海资料掘金营，微信deep3321