4、速度约束分析：关节速度极限、笛卡尔空间速度约束、奇异点规避

好，咱们接着聊速度约束。说实话，速度约束这块儿，是很多做协作机器人的工程师容易忽略的地方。大家往往盯着位置精度、力控精度，觉得速度嘛，大不了跑慢点。但实际项目里，速度约束没处理好，轻则影响效率，重则直接触发急停，甚至损坏末端工具。

我个人习惯把速度约束拆成三个层面来看：关节层、笛卡尔层，以及一个特殊的奇异点规避。这三个东西是相互耦合的，你想想看，关节速度极限是硬约束，笛卡尔速度是任务需求，而奇异点则是两者之间的“陷阱”。

4.1 关节速度极限：最底层的硬约束

每个伺服电机都有自己的转速上限，减速比一乘，就是关节的最大角速度。这个值写在电机手册里，是绝对不能超的。我在项目中遇到过，有同事为了赶节拍，把速度指令设得过高，结果电机直接报“跟随误差超限”，整条线停了。

实际控制中，我们通常用这样的方式来处理关节速度约束：

// 伪代码：关节速度限幅
for each joint i:
    if qd_i > qd_max_i:
        qd_i = qd_max_i
    else if qd_i < -qd_max_i:
        qd_i = -qd_max_i

嗯，这里要注意，简单的限幅可能会引起加速度突变。我个人习惯再加一个加速度前馈，让速度变化更平滑。说白了，就是别让电机“一脚油门踩到底”。

4.2 笛卡尔空间速度约束：任务层面的需求

关节速度是底层，但用户更关心的是末端执行器在空间里跑多快。比如焊接、涂胶，工艺要求末端线速度必须恒定在某个值。这时候，我们需要把笛卡尔速度映射到关节空间。

核心公式就是雅可比矩阵的逆：

q̇ = J⁻¹ · ẋ

其中q̇是关节速度，ẋ是笛卡尔速度。但这里有个坑——雅可比矩阵的逆不是总能求出来的。当机器人处于奇异位形时，J的行列式为零，逆矩阵不存在。这时候你强行算，关节速度会趋于无穷大。

我曾经在调试一个打磨机器人时，发现末端速度明明设得很低，但J2轴却疯狂抖动。后来一查，原来是路径经过了一个接近奇异的区域，雅可比矩阵病态，导致关节速度指令剧烈波动。从那以后，我养成了一个习惯：在规划路径时，先检查路径上所有点的雅可比条件数。

4.3 奇异点规避：绕不开的坎

奇异点，说白了就是机器人“卡住”的位置。比如六轴机器人的腕部奇异、肩部奇异。在奇异点附近，机器人会失去某个方向的运动能力，或者需要极高的关节速度才能实现微小的末端移动。

常见的规避方法有几种：

• 阻尼最小二乘法（DLS）：在求逆雅可比时加一个阻尼项，避免数值爆炸。公式是 Jᵀ(J·Jᵀ + λ²I)⁻¹。λ是阻尼系数，我一般取0.01到0.1之间。
• 奇异点附近减速：当检测到接近奇异点时，主动降低笛卡尔速度。我习惯用“奇异度”指标——比如雅可比矩阵的最小奇异值。当这个值低于阈值时，按比例减速。
• 路径重规划：如果必须经过奇异点，那就绕个路。虽然路径长了点，但至少安全。

下面这张图，是我自己总结的速度约束分析流程。你可以看到，从任务需求到关节执行，中间要经过好几层检查。

你看，整个流程其实就是一个层层过滤的过程。任务层提需求，映射层做转换，奇异点检测做保护，最后关节限幅做兜底。少了任何一层，都可能出问题。

4.4 实际项目中的避坑指南

最后，分享几个我踩过的坑：

• 别信标称速度：电机手册上的最大速度，是在空载、理想散热条件下测的。实际带负载后，要留20%~30%的余量。
• 奇异点附近别硬闯：我曾经试过用DLS强行通过奇异点，结果虽然没报错，但末端轨迹偏差很大，工件直接报废。现在我的原则是：能绕就绕，绕不过就降速。
• 加速度也要约束：速度约束只是第一步。如果加速度太大，电机电流会瞬间飙升，触发过流保护。我一般会在速度环外面再加一个加速度前馈限制。