第2章运动学约束

第二章运动学约束：速度、加速度、加加速度（Jerk）的物理意义与数学表达

各位工程师朋友，咱们今天聊聊运动学约束。说白了，就是机器人运动时那些「不能越界」的物理量。

我刚开始做轨迹规划时，总觉得只要位置走对了就行。结果呢？电机嘎嘎响，末端抖得像筛子。后来才明白——速度、加速度、加加速度，这三个量才是决定轨迹「能不能用」的关键。

速度的物理意义很简单：单位时间内位置的变化量。数学上就是位置对时间的一阶导数。

v(t) = dp(t) / dt

但实际项目中，速度约束往往不是「最大速度」这么简单。我记得有一次调试六轴机器人，手册上写着最大速度 2m/s，结果一跑就报警。后来发现——每个关节的电机转速上限不同，末端速度受关节限速的耦合影响。

核心要点：

你想想看，如果只盯着末端速度，忽略关节速度，那就像开车只看仪表盘不看发动机转速——迟早要出问题。

加速度是速度对时间的一阶导数，位置对时间的二阶导数。

a(t) = dv(t) / dt = d²p(t) / dt²

加速度约束直接决定了机器人启动和停止时的冲击力。为什么？因为 F = ma，加速度越大，电机需要输出的力矩就越大。

我曾经调试过一个码垛机器人，加速度设得太大，结果每次加减速时，末端抓手上的工件直接飞出去了。嗯，这里要注意——加速度约束不仅要考虑电机能力，还要考虑负载的惯性力。

我的经验：加速度约束最好分两段设置——粗调时用电机极限值的 70%，精调时再根据实际振动情况微调。这样既保证效率，又不会把机械结构搞坏。

加加速度，英文叫 Jerk，是加速度对时间的一阶导数，位置对时间的三阶导数。

j(t) = da(t) / dt = d²v(t) / dt² = d³p(t) / dt³

说实话，很多工程师只关注速度和加速度，完全忽略了 Jerk。但我在项目中遇到过——同样的速度和加速度限制，有 Jerk 约束和没有 Jerk 约束，轨迹的平滑度天差地别。

为什么会这样？因为加速度突变会产生冲击力。你想想看，如果加速度从 0 瞬间跳到最大值，那相当于给机械结构一个「阶跃激励」——共振、抖动、甚至结构损伤都可能发生。

避坑指南：我曾经调试一台高速并联机器人，速度和加速度都设得很合理，但运行 3 个月后，减速器出现异常磨损。排查了两个月才发现——Jerk 太大，每次加减速时冲击力反复冲击减速器齿轮。从那以后，我所有轨迹规划都强制加入 Jerk 约束。

数学上，Jerk 约束通常表示为：

|j(t)| ≤ J_max

其中 J_max 取决于：

下面这张图展示了位置、速度、加速度、加加速度之间的微分/积分关系。我个人觉得，理解了这个关系链，轨迹规划就入门了一半。

从图中可以清楚看到：位置是积分的结果，Jerk 是微分的源头。实际规划时，我们通常从 Jerk 开始设计，逐层积分得到平滑的位置曲线。

说了这么多理论，到底怎么设？我分享一个实际项目中的参数设置思路：

一个实用的经验公式：

J_max ≈ (3 ~ 5) × a_max / t_acc

其中 t_acc 是期望的加速时间。这个公式我用了七八年，基本没出过问题。

嗯，最后提醒一句——运动学约束不是越严格越好。太严格的 Jerk 约束会让轨迹变得过于保守，影响生产效率。关键是在「不损坏设备」和「跑得快」之间找到平衡点。

我个人习惯是先跑一次空载测试，观察实际的速度和加速度曲线，再根据振动传感器的反馈微调约束值。这样既科学又稳妥。