Scara机器人微分运动

两关节是Scara的典型结构，其运动学、逆运动学及微分运动计算简单，以下以两关节长度相等为条件进行运动学计算演示，l为杆件1，2长度，杆件1起点为基座零点；

 

一、            正运动学 

    

其中位置可描述为：

   

二、            逆运动学

已知当前点P(x,y)，求关节1终点MP(x1,y1)

            

当MP设定在向量（Vx,Vy）逆时针侧：

x1 = x/2 - Tm*Vy      y1=y/2 + Tm*Vx            

当MP设定在向量（Vx,Vy）顺时针侧：

x1 = x/2 + Tm*Vy      y1=y/2 - Tm*Vx 

三、            微分运动： 

  

其中雅可比矩阵： 

 

行列式值：

 

       

速度（单位向量）矩阵：

                    

演示下载