第二十讲：连续轨迹——拐角过渡、圆角过渡、速度前瞻与连续路径规划
各位好，欢迎来到第二十讲。
前面我们讲了单段轨迹的插补，比如直线插补、圆弧插补。但实际工业现场，机器人很少只走一条直线或一个圆弧。更多时候，是一连串的路径点，比如焊接、涂胶、铣削。这时候问题就来了：段与段之间怎么衔接？
如果每段都停稳再走下一段，效率太低了。如果不停，直接冲过去，那在拐角处就会产生冲击，甚至轨迹跑偏。今天我们就来聊聊这个核心话题——连续轨迹处理。
一、为什么需要连续轨迹？
先看一个简单场景。机器人要从A点走到B点，再到C点。如果每段都执行“到位-减速-停止-再加速”，你会发现：
- 加工效率至少下降30%~50%
- 工件表面会有明显的停顿痕迹
- 电机频繁启停，发热严重
所以，工业上几乎不会用“点到点停”的方式做连续路径。我们追求的是：路径连续、速度连续、甚至加速度连续。
核心目标：在保证轨迹精度的前提下，让机器人“平滑地”经过每个拐点，不掉速太多，也不产生冲击。
二、拐角过渡——最简单的处理方式
拐角过渡，说白了就是“切掉尖角”。
假设两条直线段相交于P点。如果直接走，在P点速度方向突变180度（如果是折返）或某个角度。这会导致加速度无穷大——物理上不可能实现。
我的做法是：在P点附近，提前结束第一段，晚点开始第二段。中间用一段圆弧或样条曲线连接起来。
2.1 圆弧过渡
这是最经典的方法。在拐角处插入一段圆弧，圆弧与两条直线相切。
参数就一个：过渡半径R。R越大，路径越平滑，但偏离原始路径也越远。R越小，精度越高，但速度受限。
// 拐角圆弧过渡计算示例（简化版）
// 输入：线段L1终点P，线段L2起点P，夹角θ，过渡半径R
// 输出：过渡圆弧起点S，终点E，圆心O
// 1. 计算切点距离
d = R / tan(θ/2)
// 2. 沿L1方向从P后退d得到S
S = P - d * unit_vector(L1)
// 3. 沿L2方向从P前进d得到E
E = P + d * unit_vector(L2)
// 4. 圆心O在角平分线上，距离P为 R / sin(θ/2)
O = P + (R / sin(θ/2)) * angle_bisector_vector我的经验：过渡半径不要超过段长的一半。否则过渡圆弧会吃掉整条线段，导致路径严重变形。我曾经在一个焊接项目里设了R=10mm，结果线段只有8mm长，焊枪直接飞出去了……
2.2 样条过渡
圆弧过渡虽然简单，但有个问题：曲率不连续。在圆弧与直线的连接点，曲率从0跳变到1/R，加速度会有突变。
如果要求更高（比如高速高精加工），我会用三次样条或贝塞尔曲线做过渡。它们能保证位置、速度、加速度都连续。
嗯，代价就是计算量大了不少。一般用在数控机床上，工业机器人用得少一些。
三、圆角过渡——更精细的控制
圆角过渡其实是拐角过渡的一种特例。但工业上经常单独拎出来说，因为它有明确的几何意义。
圆角过渡的关键参数是“逼近距离”或“容差”。你告诉控制器：“允许偏离原始路径最多0.1mm”，控制器会自动计算一个合适的过渡半径。
| 参数 | 含义 | 典型值 |
|---|---|---|
| 过渡半径R | 圆弧半径 | 1~50mm |
| 逼近距离d | 拐点与圆弧的最大偏差 | 0.01~1mm |
| 过渡速度v | 经过拐点时的允许速度 | 10~500mm/s |
注意：圆角过渡不是“绕过”拐点，而是“削平”拐点。如果你需要精确经过某个点（比如定位孔），那就不能用圆角过渡，必须用“到位停”模式。
四、速度前瞻——让机器人“看得远”
前面讲的都是几何层面的处理。但真正让连续轨迹跑起来的，是速度前瞻。
什么是速度前瞻？说白了就是：提前看后面几段路径，算好什么时候该减速，什么时候能加速。
我打个比方。你开车遇到连续弯道，你不会到了弯道口才刹车，而是远远看到弯道就开始减速。速度前瞻就是这个道理。
4.1 前瞻的基本流程
- 读取N段路径（N一般取10~50，取决于控制器算力）
- 分析每段的长度、曲率、允许速度
- 从后往前推算：在每段终点，速度不能超过多少？
- 从前往后规划：根据当前速度，能否在下一段终点前减速到目标速度？
- 生成平滑的速度曲线（S形曲线或梯形曲线）
// 速度前瞻核心逻辑（伪代码）
function look_ahead(segments, N):
// 第一步：计算每段允许的最大速度
for i = 0 to N-1:
v_max[i] = min(segments[i].max_speed,
sqrt(acc_max * segments[i].radius))
// 第二步：反向扫描，确定减速点
for i = N-2 down to 0:
// 从后一段往前推，看是否需要提前减速
v_need = sqrt(v_max[i+1]^2 + 2 * acc_max * segments[i].length)
v_max[i] = min(v_max[i], v_need)
// 第三步：正向规划，生成速度指令
for i = 0 to N-1:
// 根据v_max[i]和当前速度，生成S曲线
generate_s_curve(current_speed, v_max[i], segments[i].length)关键点：前瞻窗口越大，速度规划越平滑，但实时性越差。我一般设20段左右，既能保证平滑，又不会让CPU扛不住。
4.2 避坑指南
我曾经在一个六轴机器人项目里，前瞻窗口设了50段。结果在复杂路径下，控制器每周期要算几百个插补点，导致周期抖动超过1ms，电机跟着抖。后来我把窗口降到20段，再配合预计算，问题就解决了。
所以我的建议是：前瞻窗口不是越大越好，够用就行。
五、连续路径规划——把一切串起来
好了，现在我们把前面讲的都串起来，看看一个完整的连续路径规划是怎么做的。
5.1 整体流程
- 路径解析：把G代码或机器人语言解析成线段、圆弧段
- 拐角识别：判断相邻段之间的夹角，决定是否做过渡
- 过渡插入：在拐角处插入圆弧或样条
- 速度前瞻：分析整条路径，规划速度曲线
- 实时插补：按周期（比如1ms）输出位置指令
5.2 一个实际案例
去年我做了一个激光切割项目。路径是一个矩形，四个角需要圆角过渡。参数如下：
- 边长：200mm x 300mm
- 过渡半径：5mm
- 最大速度：500mm/s
- 加速度：2000mm/s²
如果不做前瞻，每个角都要减速到0再加速，总时间约3.2秒。做了前瞻后，拐角速度只降到200mm/s，总时间缩短到1.8秒——效率提升了40%以上。
小技巧：如果路径中有大量小线段（比如3D打印的切片路径），建议先做路径压缩，把共线的短线段合并，减少拐角数量。否则前瞻窗口里全是小段，速度根本提不起来。
六、总结与思考
连续轨迹处理，说白了就是三个字：快、准、稳。
- 快：通过速度前瞻，减少不必要的启停
- 准：通过圆角过渡，控制轨迹偏差在允许范围内
- 稳：通过平滑过渡，避免加速度突变
我个人觉得，这里面最难的不是算法本身，而是参数的调优。同样的算法，在不同负载、不同速度下，表现可能天差地别。所以，如果你在实际项目中遇到问题，不妨先从参数入手，看看过渡半径是不是太小，前瞻窗口是不是太大。
好了，这一讲就到这里。下一讲我们会聊聊速度规划中的S形曲线与T形曲线，看看它们各自的优缺点和适用场景。
我们下期见。