KUKA机器人运动学分析及simmulink仿真（非常不错）.docxVIP

KUKAKR40PA机器人运动学分析及simmulink仿真KukaKR40PA码垛机器人简介KukaKR40PA机器人是一种有四个自由度的码垛机器人，有四个驱动器，很好地运用了平行四边形机构，固定其姿态从而大大简化了控制难度，并且提高了精度及寿命，本文所用kuka码垛机器人如下图所示：机构简图，及其简化。机构简图如下：第一步简化原因：第一步我们简化了两个平行四边形机构，在此我们分析，这两个平行四边形机构的作用是约束末端执行器在XZ平面的姿态，即：使末端执行器始终竖直向下。在此我们人为的默认末端执行器始终竖直向下，不随前面传递构件的影响。此时便可以将两组平行四边形机构去除而不影响末端执行器的姿态和位移。第一步简化后机构简图第二步简化原因：在此我将主动杆1及连杆4去除。杆1 2 3 4组成了一个平行四边形机构，因此β3=β2-β1.所以我们将杆1杆4去除，只要使β3=β2-β1便不影响末端执行器的位置和姿态。第二步简化后的图形第三步简化原因：为了使参数更简洁，便于计算。我们将杆2的第一个关节与第一个旋转轴相交，这样简化的模型更好计算。不影响总体机构的功能。最终简化后的机构简图建立连杆坐标系。如下图：D-H参数表 iαi-1 ai-1 diθi 10 0 0θ1 2 -90 0 0 θ2 3 0l2 0θ3 4 0 l3 0θ4 5 90 0 0θ5求正运动学公式=======*==*==*=由于平行四边形机构的存在使得==*= * =所以=== *=雅克比矩阵：==至此正解完成。六、运动学逆解在此只对位置逆解进行分析，姿态逆解只与有关因此很简单就可以计算出来。假设我们给出目标位置在0坐标系表示坐标为( X , Y , Z ),由变换矩阵我们可以得出：X=Y=Z=用式除以式可以得到 tan =Y/X利用2幅角反正切公式可以得到=Atan2（y , x）。式与式可以写成如下形式：X/c1=-Z= 两式左右两边分别平方相加得到下式：+=++2c3又因为 tan1=Y/X可解得c3=(++--)/2S3= (在此期望值S3大于0，因此取正)再次利用2幅角反正切公式可以得到 =Atan2（s3 , c3）。可写成如下形式X/c1=c2-s2 ⑥-z= s2+c2 ⑦式中=+=s3r=那么⑥⑦式可以写成X/(rc1)=c(+2)Z/(-r)=s(+2)所以+=Atan2（-zc1，X）=Atan2（-zc1，X）-至此逆解完成七、轨迹规划：加速度表达式是一个三次多项式，速度表达式是一个四次多项式，位移表达式是一个五次多项式。设S为无量纲的运动位移，为无量纲的运动总时间，V、A为无量纲的运动速度及加速度，那么3-4-5多项式运动曲线可以简单表示如下：（3-1）（3-2）（3-3）根据如下边界条件：(1) 当时，，，；(2) 当时，，，。将以上边界条件代入上述多项式表达式，可解出多项式的系数，，，，，。于是，我们得到3-4-5多项式运动曲线的表达式：（3-4）（3-5）（3-6）由加速度多项式可解出。为了得到带有量纲的多项式运动曲线表达式，我们令其加速度的最大值为，运行总时间为，运行瞬时时刻，有（3-7）将上式对积分得：（3-8）同理有：（3-9）由此，当时：（3-10）八、基于matlab simmechanics工具箱的运动学仿真在matlab命令窗口中输入 simulink命令回车弹出simulink library browser如下图：新建一个model ，在左侧 libraries中选择simscape接着选择simmechanics将我们见立模型的构建分别拖到model并组成下图形式，其中各模块参数输入如下： 环境模块 关节模块Body0 的参数Body1的参数Body2的参数Joint actuator的参数驱动函数模块的编程：1、基于末端执行器x,y,z分别按照轨迹规划路径的函数编程function c =sita(t,T,a1,b1,c1,a2,b2,c2)s1=1;s2=1;s3=1;sxmax=abs(a2-a1);axmax=sxmax*5.774/T^2;if a2a1 s1=-1;elseif a2=a1 s1=1;endx=a1+s1*(axmax/5.774)*(6*(t^5)/T^3-15*(t^4)/T^2+10*(t^3)/T);symax=abs(b2-b1);aymax=