(完整word版)平面双连杆机械臂动态模型(word文档良心出品)

1、构建平面双连杆机械臂动态模型1 .平面双连杆机械臂的分析图1平面双连杆机械臂8平面双连杆机械臂如图 1,图中。1为关节1转角，0 2为关节2转角，11为杆1的长度，12 为杆2的长度，r1为关节1到杆1质心的距离，r2为关节2到杆2质心的距离,M1为负载质量。以 图中的。为原点的Xo yo为基坐标。2 .数学建模2.1 寻找动力学 末端坐标Xpi11cos112 cos(12)ypi11 sin112 sin(12)根据雅克比矩阵的形式dx dxJ 12dy dy12对末端坐标进行微分得到末端速度方程X p11 1 1 sin112(12)sin(12)yp111 1 cos112(12)co

2、s(12 )其中1(3)、(4)11s11 1c1两式联立整理成速度雅克比矩阵形式1 2s121 2c121 2s121 2c122),c12 = cos( 1其中 s1 = sin 1 , c1 = cos 1, s2sin 2，c2 cos 2，s12=sin( 1在机器人基础坐标系中的速度与各关节速度间的关系以及手部与外界接触力与对应各关节间的关系可以利用雅克比矩阵来建立。对机械臂末端速度方程（ 下3）、方程（4）进行求导得到末端加速度方程如x p1yp1(11S1(11S11 2S12)1 2S12)11 2S12 211 2S122(11c1(11S11 2c12) 112s12 )

3、 11 2c121 2s12222221 21 2c1221 212S12其中上述推导的方程构成了进行动力学仿真的基础,它们表明了有效负荷的加速度与两节点处电动机的角速度和角加速度之间的关系。 程如下机械臂质心位置的加速度和关节处的变量之间关系方Ac1Ac1,x,yA,xA2,y(11S(11C内12121r2S12) 1 r2c12)1r 2s12 2r 2S12 2(11c1(11S11 2c12 )1 2s 12 )21221112c12221212c12112c12221212S122.2构建拉格朗日模型2.2.1 选定广义关节变量及广义力选取笛卡尔坐标系。01为关节1转角，0 2连杆

4、1和连杆2的质量分别为m,和m2, 11为杆1为关节2 的长度，转角，关节1和关节2相应的力矩是1和2。12为杆2的长度,质心分别为 k1和k2 n为关节1到杆1质心的距离,r2为关节2到杆2质心的距离。因此，杆1质心k1的位置坐标为X1Y1rs 1rc 1杆1质心k1速度的平方为2.2.2系统动能X12Y12(r1 1)2X21 1S 1r2s12丫21 1c 1r 2c12X21 1C 1 1r 2c12( 12)丫21 1S 1 1r 2s12( 12)X；丫2212 2221 1r2( 12)EkEkii 1,2杆1质心k2的位置坐标为杆1质心K速度的平方为21211r2( 122)c

5、 22.2.3系统势能Ek21212mr；mJ 12一 2/mi2（12)2m212r2(1 2)C 2EpEpi1,2EpiEgM1c i)Ep2m>gli(1c 1)rnigr"C12)2.2.4 拉格朗日函数LEkEp1 22221222( mlr 1m2l 1) 1m2l1r2(112)c22m2r 2(12)(mim2l1)g(1c 1)mgr"C12)2.2.5 系统动力学方程根据拉格朗日方程式计算各关节上的力矩，得到系统动力学方程。 计算关节1上的力矩12.22,、(51m2l1) 1m211r42 12)c 2m22( 12)1(m1m2l 1 )gs

6、 1m2gr2s121所以d LL1 彳二二,2222(用1m2r2ml 12m211r2c2) 1( m2r2m211r2c2) 22(2mhr2s2) 1 2(m2l1r2s2)2(mlJmJJgs 1migr2s12计算关节L1上的力矩2/m2r2( 12)网1r21c 22)s 2m2gr2s122所以d Ldt 2(啊 12s2(m¥22同 12s 2)m2l /2c 2) 12mA 2、22) 1叫gr2s122.3建立动力方程将两个关节电机输入转矩作为输入，根据 2.1中的角度、角速度、角加速度的方程和建立的拉格朗 日方程，我们可以建立含 14维矩阵的动力方程如下：h

7、X + h si2收电0I)0(00 0000h ft - k Qz-h Gz0n00010fl0fl00nMC1(10口000flQfl0n-n Q0010D00000000h 51t h Sa立5堂00100000Q000A G + 4 Qa- r> Ch00010000000000- M00000101000000-A/|0000010100Ji000000000h S-力G000Q0u-施I)000u-1u10000II0-他00000-1(J10Jz0II0I)0(00 $12 Gz(4- JW 5)z-泣-n) cz000000“00000100000000%000001.做

8、4匚/人力Api*建¥ ft A 用“ Pix 陌产-ftzf- / f 7i C + ft GJ 诵 + Ga + 2 力助在 G“ 七 1 (h Ci + 也 Sz)腐 +，z S12 次 + 2，2 助做 512 / -门a &- n $成- 1(h C + C2)晶 + 0 G2 0 + 2 m 例初 Gz，- f( h Si + & S2)届 + h S12/ + 2 眨助力5“ 0Migq-Q -跖 gr Ci0Mg到0- - Mpig-3 .二连杆机械臂的动力学matlab/simulink 仿真图2是一个合理的Simulink模型原理图。值得注意的是

9、，到两个电动机的转矩被输入到了仿真系统 中，而且轴承摩擦力的简单模型也加了进去。一般来说，摩擦是组织运动并且和速度有关的力或者力矩。在图5中采用了一种线性的摩擦力模型。在该模型中，抵抗输入转矩的摩擦力矩与转速成正比。两个标“Damp2ing”的增益模块标示的是由于轴承和电动机的黏滞阻尼而产生的速度的损失，这些系数的实际值是很难确定的，但是在操纵机器人装置时，某些能量的消耗是客观存在的，在模型中缺少对能两消耗的考虑将会导致较大的误差和得到不符合实际的仿真结果。H-HlFan-tallha 2Im电InlEKraftarlDrafia- Jihclt-2.MAn.An . Fii&dldf

10、li robot 1 inInicrajiof 1lute斯曲3Scopel r-：. JucdlariiJtM.【*"1假收 lnik»r»or1 In4曜nki幡IftlcigralBwTjrrnniphFOKtK图2 simulink 仿真图初始条件选择。1 = 0和0 2 =兀/ 2rad 。这对机械臂的末端位置 xpl = 1.0 和ypl = 1.0 。如同 所有的仿真一样，积分求解器的促使条件必须是相容的。为了在仿真中获得较高的可信度，需要做一个简单的实验。回想一下机械臂在垂直平面工作时在重力作用下的受力图。因此，如果让机械臂从任何初始位置开始运动，

11、将输入的转矩值设置为零，那么机 械臂将在自重的作用下下落，最后到达两个连杆都在一条铅垂线上的位置。图3给出了机械臂Simulink仿真图，其上数据点表明了机械臂末端位置随时间变换的规律。曲线 图中显示的运动轨迹与我们所想到的让机械臂在自重作用下下降的运动情形相一致。图4给出了关节转角。1和。2的转角曲线，在经过一定的仿真时间后，机械臂运动趋于稳定后，两关节的转角像设想的 一样0 1变为-兀/2 , 0 2变为0与机械臂在自重下结束态姿相吻合。XT Plot2 IiilIII-2-E5 -1-0.500.5 I L5 2片轴图3 simulink 仿真结果曲线一杆机械臂关H转箱变化曲线芹时间图4关节转角。1和。2的变化曲线我们得到了一个平面二连杆机械臂动态模型并在Simulink 环境下实现了这个模型。这种模型的仿真是很难在更为一般的环境下实施的，这是因为封闭形式的运动方程是非常复杂的，也是很难精确解答的。另外这种类型的仿真对于了解复杂的多链式机器人操纵装置的动力特性以及在解决对这些系统实施 控制过程中遇到的困难时是非常有用的，机械臂运动学模型的建立是研究机械臂轨迹规划和控制策略的前提和基础。4 .总结通过机器人控制技术这门课程的