三自由度机械臂的笛卡尔空间轨迹规划实战解析

1. 从零开始：什么是笛卡尔空间轨迹规划？

如果你玩过遥控玩具车，想让小车从客厅的茶几移动到电视柜，你脑子里规划的路径通常是一条直线或者一条平滑的曲线，对吧？这条路径就是小车在“客厅”这个空间里的运动轨迹。对于机械臂来说，笛卡尔空间轨迹规划干的事儿跟这个特别像，只不过我们把“客厅”换成了数学上的笛卡尔坐标系（也就是XYZ三维直角坐标系），把“小车”换成了机械臂末端的那个工具（比如夹爪、焊枪）。

为什么要在笛卡尔空间里规划呢？因为它最直观。你不需要去关心机械臂的每个关节要转多少度，你只需要告诉它：“嘿，夹爪，请在2秒内从A点（X1， Y1， Z1）直线运动到B点（X2， Y2， Z2）。” 剩下的复杂计算——每个关节电机该怎么配合转动——交给机械臂的控制系统去完成。这就像你作为老板，只下达“拿下这个市场”的战略目标，具体战术执行交给专业的团队。这种规划方式在工业分拣（把零件从传送带A抓到托盘B）、自动化装配（把螺丝精准地拧到指定孔位）、涂胶焊接（沿着工件缝隙走一条复杂的三维曲线）等场景中应用极广。

与它相对的是关节空间轨迹规划。那相当于你直接指挥每个关节：“关节1，用1秒转到30度；关节2，用1.5秒转到45度……” 这种方式虽然控制直接，但非常不直观，你很难想象这一串关节角度组合起来，末端到底会走出什么诡异的路径，甚至可能撞到障碍物。所以，对于大多数需要精确控制末端路径的应用，笛卡尔空间规划是首选。

轨迹规划的核心目标就三个：让末端走指定的路、在规定的时间到达、并且走得要稳。这个“稳”非常关键，意味着速度不能突变（否则会产生冲击，损坏机械臂或工件），加速度最好也能连续变化。这就引出了我们接下来要详细拆解的两种经典实现方法：三次多项式插值和直线-抛物线混合规划。我会用大量我实际调试过的例子，带你一步步理解并上手实现。

2. 平滑之选：三次多项式轨迹规划详解

当你希望机械臂的运动如丝般顺滑，速度和加速度都没有突变时，三次多项式是一个优雅而强大的数学工具。它的核心思想很简单：我们用一条光滑的曲线去连接轨迹上的各个关键点（这些点叫做路径点或via points）。

想象一下你要开车从家（起点）经过一个加油站（中间点）到公司（终点）。你不能在家门口一脚油门踩到底，然后在加油站猛踩刹车，接着又瞬间弹射起步。三次多项式规划，就是帮你计算出从“踩油门”到“松油门”再到“刹车”这个过程中，每一个瞬间的位置、速度甚至加速度都应该是什么样的，让整个过程平滑过渡。

从数学上看，我们假设位置（P）和时间（t）的关系是一个三次方程： P(t) = a₀ + a₁*t + a₂*t² + a₃*t³ 对这个方程求一次导，得到速度（V）：V(t) = a₁ + 2*a₂*t + 3*a₃*t²，这是一个二次曲线。 再求一次导，得到加速度（A）：A(t) = 2*a₂ + 6*a₃*t，这是一个一次函数（直线）。

看到这里你可能会问，这些a₀， a₁， a₂， a₃系数怎么定？这就是规划算法的任务：我们需要根据已知的边界条件来解出这些系数。通常的边界条件包括：每个路径点的位置、在路径点处的速度（通常起点和终点速度设为0）、以及为了