三次多项式:
1.位移
2.速度
3.加速度
在实际工作中,以六自由度旋转关节若此时我们已知需要到达的目标位置,通过运动学求逆解得到关节需要到达的角度位置。
假设我们已知关节的初始角度、求得的目标角度位置;而初始时,关节的角速度必然为0,结束时,目标角度位置的速度也为0,则可以得到以下四个约束方程:
将上面四个边界条件代入上面的公式1,我们可以得到四个系数的表达式:
至此,关节运动轨迹的三次多项式插值表达式求出。