基于matlab的2R机械手路径规划与仿真
作者：李跃松 南京航空航天大学机电学院
2R机械手如图（一），在O点，臂l1和l2的交点处各有一个电机，分别控制了l1与x轴，l2与l1轴之间的夹角 和 。
图（一） 2R机械
由上图可以的关系式：
1，三次样条函数：
假设x的位置有t0时刻的x0运动到tf时刻的xf，x在运动前后速度都为0；采用三次多项式样条函数，路径表示为：
速度表达式可以用x的导数表达为：
位置和速度必须满足下列边界条件，即
在t0时刻
在tf时刻
把边界条件代入路径和速度的表达式得，
从而解得，
代入路径表达式得，路径为：
下面就路径为直线就行研究：
若路径为直线y的运动满足下面关系式：
对图（一）机械手求逆向运动学方程，
请搜“两自由度机械手2”