机械毕业设计1167R六杆Ⅲ级机构的动态仿真论文

1、 TOC o 1-5 h z 1绪论(2)弓 1言(2) HYPERLINK l bookmark17 o Current Document 1.2平面连杆机构及杆组概述(2) HYPERLINK l bookmark20 o Current Document 1.3进行杆组系统仿真的意义(3) HYPERLINK l bookmark23 o Current Document 1.4仿真软件的发展状况与应用(3)1.5 MATLAB 概述(3) HYPERLINK l bookmark26 o Current Document 7R六杆III级机构运动学仿真(5)2.1曲柄原动件运动学分析(

2、5)6RI级杆组运动学分析(6)7R六杆III级机构MATLAB仿真积分模块初值的确定(11)7R六杆I级机构运动学仿真模型及结果(16) HYPERLINK l bookmark47 o Current Document 7R六杆III级机构动力学仿真(23)3.1曲柄原动件动力学数学模型的建立(23)6RI级杆组动力学数学模型的建立(25)需要引用的函数(30)7R六杆I级机构运动学仿真模型及结果(32) HYPERLINK l bookmark53 o Current Document 结论(39) HYPERLINK l bookmark58 o Current Document 参考

3、文献(40) HYPERLINK l bookmark61 o Current Document 致谢(41)1绪论1.1引言大学的四年生活，通过老师的讲解和我自己的学习，我收获了很多，我也深深的 喜欢上了机械这个行业，对机械加工和制造方面尤为感兴趣，我觉得通过自己的努力 和思考来改变工艺规程来提高生产效率，提高经济效益很有成就感。我所研究的课题 就是给了这样的机会我可以通过我的努力来优化工艺规程，提高经济效益。此次毕业 设计，是在我们学完了机械制造工艺学、工艺装备设计等课程，进行了生产实习之后， 进行的一个重要的实践性环节。这要求我们把所学的工艺理论和实践知识，在实际的 工艺、夹具设计中综合

4、地加以运用，这有助与提高了我们分析和解决生产实际问题的 能力，为以后从事相关的技术工作奠定的基础。1.2平面连杆机构及杆组概述平面连杆机构是将各构件用转动副或移动副联接而成的平面机构。最简单的平面 连杆机构是由四个构件组成的，简称平面四杆机构。它的应用非常广泛，而且是组成 多杆机构的基础。全部用回转副组成的平面四杆机构称为铰链四杆机构。仅能在某一角度摆动的连 架杆，称为摇杆。对于铰链四杆机构来说，机架和连杆总是存在的，因此可按照连架 杆是曲柄还是摇杆，将铰链四杆机构分为三种基本型式：曲柄摇杆机构、双曲柄机构 和双摇杆机构。在实际机械中，平面连杆机构的型式是多种多样的，但其中绝大多数是在铰链四

5、杆机构的基础上发展和演化而成。如曲柄滑块机构、导杆机构等。任何机构都是由原动件、机架和从动件构成的系统。由于机架的自由度为零，一 般每个原动件的自由度为1，且根据运动链成为机构的条件可知，机构的自由度与原 动件为应相等，所以，从动件系统的自由度数必为零。机构的从动件系统还可以进一 步分解成若十个不可再分的自由度为零的构件组合，这种组合称为杆组。设n表示活 动构件数，PL表示低副个数，根据n的取值不同，村级可分为II级杆组和III级杆组。 其中11级杆组分为5种：RRRII级杆组、RRPII级杆组、RPRII级杆组、PRPII级杆 组以及RPPII级杆组。任何机构都可以看作是由若十个基本村级依次

6、联接于原动件和机架而构成的，这 就是所谓机构的组成原理。通常，把由最高级别为II级杆组的基本杆组构成的机构称 为II级机构；把最高级为III级杆组的基本杆组构成的机构称为III级机构。1.3进行杆组系统仿真的意义系统仿真是建立在控制理论、相似理论、信息处理技术和计算机初等理论基础之 上的，以计算机和其他专用物理效应设备为工具，利用系统模型对真实或假设的系统 进行试验，并借助于专家的经验知识、统计数据和信息资料对实验结果进行分析研究， 进而做出决策的一门综合的实验性学科。仿真技术是分析、研究各种系统，尤其是复杂系统的重要工具。随着机械行业的 迅速发展，对研究、设计的机械设备越来越复杂，用于制造各

7、种零件的材料价格越来 越昂贵，不可能每一步都采取试制再修改的方法进行设计，采用仿真的方法可以在一 定程度上克服这种不足的不足，降低研究成本，提高效率。而连杆机构作为常见的传 动机构，对其进行运动学和动力学仿真，建立起基本杆组模块的仿真模型，无疑对日 后的设计大有裨益。一般机构的运动分析，使用Quik BASIC语言或Fortran语言编写程序进行计算， 其缺点“透明性”差，修改麻烦等.而用MATLAB对机构进行运动仿真，利用MATLAB 的simulink仿真模型的数据可视化的特点，就可以很容易观察到运动参数是如何变化 的，极其简便.同时，用MATLAB建立和修改仿真模型具有方便、快捷、很容易

8、扩展 等优点.MATLAB仿真求解器提供很多解不同微分方程的方法，可以根据不同的微分 方程类型选择相应的求解方法.机构的动力学分析，由已知工作阻力，求出运动副的约束反力和驱动力（或力矩）， 为选择和设计轴承和零部件强度的计算及选择原动机提供理论依据。1.4仿真软件的发展状况与应用早期的计算机仿真技术大致经历了几个阶段：20世纪40年代模拟计算机仿真； 50年代初数字仿真；60年代早期仿真语言的出现等。80年代出现的面向对象仿真技 术为系统仿真方法注入了活力。我国早在50年代就开始研究仿真技术了，当时主要 用于国防领域，以模拟计算机的仿真为主。70年代初开始应用数字计算机进行仿真 4。随着数字计

9、算机的普及，近20年以来，国际、国内出现了许多专门用于计算机 数字仿真的仿真语言与工具，如CSMP，ACSL， SIMNOM， MATLAB/Simulink， Matrix/System Build，CSMP-C 等。1.5 MATLAB 概述MATLAB是国际上仿真领域最权威、最实用的计算机工具。它是MathWork公 司于1982年推出的一套高性能的数值计算和可视化数学软件，被誉为“巨人肩上的 工具”。MATLAB是一种应用于计算技术的高性能语言。它将计算，可视化和编程结合 在一个易于使用的环境中，此而将问题解决方案表示成我们所熟悉的数学符号，其典 型的使用包括：.数学计算.运算法则的推

10、导.模型仿真和还原.数据分析，采集及可视化.科技和工程制图.开发软件，包括图形用户界面的建立MATLAB是一个交互式系统，它的基本数据元素是矩阵，且不需要指定大小。 通过它可以解决很多技术计算问题，尤其是带有矩阵和矢量公式推导的问题，有时还 能写入非交互式语言如C和Fortran等。MATLAB的名字象征着矩阵库。它最初被开发出来是为了方便访问由LINPACK 和EISPAK开发的矩阵软件，其代表着艺术级的矩阵计算软件。MATLAB在拥有很多用户的同时经历了许多年的发展时期。在大学环境中，它 作为介绍性的教育工具，以及在进阶课程中应用于数学，工程和科学。在工业上它是 用于高生产力研究，开发，分

11、析的工具之一。Simulink概述 Simulink是用于仿真建模及分析动态系统的一组程序包，它支持线 形和非线性系统，能在连续时间，离散时间或两者的复合情况下建模。系统也能采用 复合速率，也就是用不同的部分用不同的速率来采样和更新。Simulink提供一个图形化用户界面用于建模，用鼠标拖拉块状图表即可完成建 模。在此界面下能像用铅笔在纸上一样画模型。相对于以前的仿真需要用语言和程序 来表明不同的方程式而言有了极大的进步。Simulink拥有全面的库，如接收器，信号 源，线形及非线形组块和连接器。同时也能自己定义和建立自己的块。模块有等级之 分，因此可以由顶层往下的步骤也可以选择从底层往上建模

12、。可以在高层上统观系统， 然后双击模块来观看下一层的模型细节。这种途径可以深入了解模型的组织和模块之 间的相互作用。2 7R六杆III级机构运动学仿真2.1曲柄原动件运动学分析曲柄原动件运动学数学模型的建立图1曲柄的复数坐标系如图1所示，在复数坐标系中，曲柄AB复向量的模rj为常数、幅角。j为变量，通 过转动副人与机架连接，转动副A的复向量的模%为常量、幅角。i为常量，曲柄AB端 点B的位移、速度和加速度的推导如下：(2.1)A = r = rej%, r = r ej jB = A + r = rej% + r ej j将方程2.1两边对时间t求两次导数得：7B = r % ej(%j +兀

13、 + r % ej(%j +兀/2) (2 2)j jj j由式2.2写成矩阵形式有Re BIm B(2.3)r % cos(0 + 冗 / 2) + r 0 2 cos(0 + 冗)j j jj j jr 0 . sin(0 . +兀 / 2) + r 0 2 sin(0 . +兀)曲柄MATLAB运动学仿真模块M函数function y=crank(x)%x(1)=rj%x(2)=thetaj%x(3)=dthetaj%x(4)=ddthetaj%y(1)=ReddB根据式(2.3)编写曲柄原动件MATLAB的M函数如下:曲柄杆长曲柄与水平方向夹角曲柄角速度曲柄角加速度转动副B加速度实轴分

14、量 %y(2)=ImddB 转动副B加速度虚轴分量 ddB=x(1)*x(4)*cos(x(2)+pi/2)+x(1)*x(3)2*cos(x(2)+pi);x(1)*x(4)*sin(x(2)+pi/2)+x(1)*x(3)、2*sin(x(2)+pi);y=ddB;此函数模块用于计算转动副B的加速度的水平分量和垂直分量输入参数为曲柄 的长度、角位移、角速度和角加速度；输出参数为曲柄端部(转动副B)的加速度的 水平分量和垂直分量。2.26皿级杆组运动学分析2.2.1 6Rm级杆组运动学数学模型的建立图2 6RIII级杆组的位置参数如图2所示，在复数坐标系中，由3个外转动副(B,C,D)和3个

15、内转动副(E,F,G),4个 构件(BE,CF,DG和EFG)构成1个6RIII级杆组，构件BE,CF,DG的长度分别为r. rk构件 EFG的3个边为e, f, g,方向如图所示，规定所有复向量与实轴正方向逆时针夹角为 0,并用相应的下标来区别，用B,C,D,E,F和G分别表示该转动副的复数坐标，则各 个构件的运动参数推导如下：E B + rejiF C + r ejQ jj(2.4)G D + r ejkKkf E G fej f(2.5)g F E *。g将式（2.4 ）代入式（2.5）并整理得:-r ej% + r e j。j - gejs = B - C-罕吧 + /% - eefi

16、e = C - D （26） rej% - r ej%k - fe 为 f = D - B将式（2.4）全式（2.6）三式合并成矩阵得：rej （,. +兀i0rej （ +兀 /2） ir ej（j +兀/2）jr ej（j +兀/2）0r ej（k +兀/2）kr ej（k +兀/2） keej （e +兀/2）0fej（ f+兀/2）gej （ g +兀/2）0i.Jke6f-g.2i.2jO；k2e2f2-g -1rej （,. +兀）i0rej （,. +兀）iB- CC- DD- Br ej （ j +兀） jr ej （ Jj0r ej （ k +兀） k一 r ej（kk一 e

17、ej （e +兀）fej （f一 gej （ g+兀）0（2.7）将式（2.7）展开整理得:- r cos（. +-r sin（.r cos（. +；）r cos（. + ；）兀-r cos（. + ）兀、cos（ + ）-g cos（r cos（ + ）ii2r sin（ +）ii2兀cos（k + ）r sin（ + ；）一 r cos（ +：）一 r sin（ +）2兀-e cos（ + ）一 e sin（ + ；）一 f cos（f + 2） f sin（f +） g 2 g sin（g +；）00.（T；r cos（ +丸）r sin（ +丸）0 0r cos（ +丸）r sin（

18、+丸）r cos（ +丸） r sin（ +丸）r cosrj（ +丸）sin（+丸）J0000r cos（0 +丸）r sin（ +兀）k kr cos（0 +丸）r cos（0 +丸）00 r cos（0 +兀）00 r cos（0 +兀）e cos（ +兀）00-e.e sin泌 +兀）00e0 f cos（ +兀）00 f cos（ +兀）0fRe B- Re C0,2j*.*Im B-Im C0*20*2e+Re C Re DIm C- Im D0，2gRe D Re B _Im D Im B_；L g（2.8）点E, F, G的加速度分别为Re gRe B+八兀 cos(0 + *

19、_Im矿_ Im B_疝0.+1） _r 0 +i i=Re C+八冗1 co戏 j+*Im FIm Csin（0 + 业）L j 2cos（ + 兀）iisin（ +兀）0 +jr 02;icos（0 +兀）jsin（0 + 兀）jr 02j jRe G=Re D+cos（0k+京.r 0 +cos（0 + 兀）-kLIm GLIm Dsin（0Lk+;） 一k ksin（0 + 兀）LkJr 02k k（2.9）2.2.2 6RO级杆组MATLAB运动学仿真模块M函数根据式(2.9)编写6RIII级杆组MATLAB的M函数如下:function y=R6ki（x）%x（1）=riBE杆长%

20、x（2）=rjCF杆长%x（3）=rkDG杆长%x(4)=eFG杆长%x(5)=fGE杆长%x(6)=gEF杆长%x(7)=theta-iBE杆与水平方向夹角%x(8)=theta-jDF杆与水平方向夹角%x(9)=theta-kDG杆与水平方向夹角%x(10)=theta-eFG杆与水平方向夹角%x(11)=theta-fGE杆与水平方向夹角%x(12)=theta-gEF杆与水平方向夹角%x(13)=dtheta-iBE杆角速度%x(14)=dtheta-jEF杆角速度%x(15)=dtheta-kDG杆角速度%x(16)=dtheta-eGE杆角速度%x(17)=dtheta-fGE杆角

21、速度%x(18)=dtheta-gEF杆角速度%x(19)=ReddB转动副B加速度实轴分量%x(20)=ImddB转动副B加速度虚轴分量%x(21)=ReddC转动副C加速度实轴分量%x(22)=ImddC转动副C加速度虚轴分量%x(23)=ReddD转动副D加速度实轴分量%x(24)=ImddD转动副D加速度虚轴分量%y(1)=ddtheta-iBE杆角加速度%y(2)=ddtheta-jCF杆角加速度%y(3)=ddtheta-kDG杆角加速度%y(4)=ddtheta-eFG杆角加速度%y(5)=ddtheta-fGE杆角加速度%y(6)=ddtheta-fEF杆角加速度%y(7)=R

22、eddE转动副E加速度实轴分量%y(8)=ImddE转动副E加速度虚轴分量%y(9)=ReddF转动副F加速度实轴分量%y(10)=ImddF转动副F加速度虚轴分量%y(11)=ReddG转动副G加速度实轴分量%y(12)=ImddG转动副G加速度虚轴分量a=-x(1)*cos(x(7)+pi/2) x(2)*cos(x(8)+pi/2) 0 0 0 -x(6)*cos(x(12)+pi/2);-x(1)*sin(x(7)+pi/2) x(2)*sin(x(8)+pi/2) 0 0 0 -x(6)*sin(x(12)+pi/2);0 -x(2)*cos(x(8)+pi/2) x(3)*cos(

23、x(9)+pi/2) -x(4)*cos(x(10)+pi/2) 0 0;0 -x(2)*sin(x(8)+pi/2) x(3)*sin(x(9)+pi/2) -x(4)*sin(x(10)+pi/2) 0 0;x(1)*cos(x(7)+pi/2) 0 -x(3)*cos(x(9)+pi/2) 0 -x(5)*cos(x(11)+pi/2) 0;x(1)*sin(x(7)+pi/2) 0 -x(3)*sin(x(9)+pi/2) 0 -x(5)*sin(x(11)+pi/2) 0;c=-x(1)*cos(x(7)+pi) x(2)*cos(x(8)+pi) 0 0 0 -x(6)*cos(x

24、(12)+pi);-x(2)*sin(x(7)+pi) x(2)*sin(x(8)+pi) 0 0 0 -x(6)*sin(x(12)+pi);0 -x(2)*cos(x(8)+pi) x(3)*cos(x(9)+pi) -x(4)*cos(x(10)+pi) 0 0;0 -x(2)*sin(x(8)+pi) x(3)*sin(x(9)+pi) -x(4)*sin(x(10)+pi) 0 0;x(1)*cos(x(7)+pi) 0 -x(3)*cos(x(9)+pi) 0 -x(5)*cos(x(11)+pi) 0;x(1)*sin(x(7)+pi) 0 -x(3)*sin(x(9)+pi)

25、0 -x(5)*sin(x(11)+pi) 0;b1=c*x(13)A2;x(14)A2;x(15)A2;x(16)A2;x(17)A2;x(18)A2;b2=x(19)-x(21);x(20)-x(22);x(21)-x(23);x(22)-x(24);x(23)-x(19);x(24)-x(20);b=b1+b2;ddtheta=inv(a)*b;y(1)=ddtheta(1);y(2)=ddtheta(2);y(3)=ddtheta(3);y(4)=ddtheta(4);y(5)=ddtheta(5);y(6)=ddtheta(6);y(7)=x(19)+x(1)*ddtheta(1)*

26、cos(x(7)+pi/2)+x(1)*x(13)A2*cos(x(7)+pi);y(8)=x(20)+x(1)*ddtheta(1)*sin(x(7)+pi/2)+x(1)*x(13)A2*sin(x(7)+pi);y(9)=x(21)+x(2)*ddtheta(2)*cos(x(8)+pi/2)+x(2)*x(14)A2*cos(x(8)+pi);y(10)=x(22)+x(2)*ddtheta(2)*sin(x(8)+pi/2)+x(2)*x(14)A2*sin(x(8)+pi);y(11)=x(23)+x(3)*ddtheta(3)*cos(x(9)+pi/2)+x(3)*x(15)A

27、2*cos(x(9)+pi);y(12)=x(24)+x(3)*ddtheta(3)*sin(x(9)+pi/2)+x(3)*x(15)A2*sin(x(9)+pi);这个模块用于求III级杆组中各杆的加速度的水平及垂直分量。输入参数为构件2、构件3的角位移和角速度，构件2、构件3和构件4的杆长，构件5的3个边长，构 件2、构件3、构件4的角位移和角速度，构件5的3个边向量的角位移和3个转动 副B,C,D的加速度；输出参数为构件2、构件3和构件4的角加速度，构件5的3个 边向量的角加速度和转动副E,F,G的加速度。2.3 7R六杆4级机构MATLAB仿真积分模块初值的确定运用牛顿一辛普森法进行

28、角位移分析图3 7R六杆III级机构图3所示是由原动件(曲柄1)和一个6RI级杆组所组成的7R六杆I级机构，复数向量坐标亦如图所示，各构件的尺寸为r=120mm，r =400mm，r =300mm，I J I - I- xj Xr-I IM / I /-J、， 7 入1入且兀_1且兀_1，入 2，UVLJ_L AAA，入 3 W且 A A 且 Ad.，r4=300mm，ReD=250mm，FG=450mm，GE=180mm，EF=350mm，ImD=350mm， ReC=700mm，ImC=350mm，构件1以等角速度10rad/s逆时针方向回转，试求构件2 和构件3的位移、速度和加速度。由图

29、3可列以下三个方程：AB+BE-AD-DG -EG=0，(2.10)(2.11)(2.12)即 r1+r2-AD-r4-f=0AB+BE+EF-AC-CF=0即 r1+r2+g-AC-r3=0EF+FG+GE=0,即 g+e+f=0rej1 + r e 元2 一 ADefi1一由复向量坐标，可写出式(2.10)、式(2.11)及式(2.12)的角位移方程为:AD 一 r4ej04 一 f - .f = 0(2.13)(2.14)(2.15)rej&1 + r ej2 + g - ejg - ACejAC - r ej3 = 0 TOC o 1-5 h z 123e - eR + f - ej

30、+ g - e凡=0f (0 ,0 ,0 ) = r cos(0 ) + r cos(0 ) 一 AD cos(0 ) 一 r cos(0 ) 一 f - cos(0 ) = 024 f 1122AD 44f将式(2.13)、式(2.14)、式(2.15)展开，整理得:,0 ,0 ) = r sin(0 ) + r sin(0 ) 一 AD sin(0 ) 一 r sin(0 ) 一 f - sin(0 ) = 024 f 1122AD 44ff (0 ,0 ,0 ) = r cos(0 ) + r cos(0 ) 一 AC cos(0 ) 一 r cos(0 ) 一 g - cos(0 )

31、= 023 g 1122AC 33gf (0 ,0 ,0 ) = r sin(0 ) + r sin(0 ) 一 AC sin(0 ) 一 r sin(0 ) 一 g - sin(0 ) = 023 g 1122AC 33gf (0 , 0 ,0 ) = e - cos(0 ) + f - cos(0 ) + g - cos(0 ) = 0e f gefgf (0 , 0 , 0 ) = e - sin(0 ) + f - sin(0 ) + g - sin(0 ) = 0e f gefg由式(2.16)求出雅可比矩阵为:一 r sin(0 )0 r sin(0 )2244r cos(0 )0

32、 一 r cos(0 )2244一 r sin(0 ) r sin(0 )0J =2233r cos(0 ) 一 r cos(0 )02233000000(2.16)0f .物0J00- f - cos(0f )000g - sin(0 )00- g - cos(0一 e - sin(0 )- f - sin(0 ) - g - sin(0 )e - cos(0 )f - cos(0 ) g - cos(0 )efg(2.17)function y=r6posi(x)%x(1)=theta-1%x(2)=theta-2%x(3)=theta-3%x(4)=theta-4%x(5)=theta-

33、e%x(6)=theta-f%x(7)=theta-g%x(8)=theta-AC%x(9)=theta-AD%x(10)=r1%x(11)=r2根据式(2.16)、式(2.17)，由牛顿一辛普森求解方法得编制M函数如下:杆1与水平方向夹角杆2与水平方向夹角(估计量) 杆3与水平方向夹角(估计量) 杆4与水平方向夹角(估计量) 杆e与水平方向夹角(估计量) 杆f与水平方向夹角(估计量) 杆g与水平方向夹角(估计量) AC与水平方向夹角 AD与水平方向夹角 杆1长度 杆2长度杆3长度杆4长度%x(12)=r3%x(13)=r4%x(14)=e杆e长度%x(15)=f杆f长度%x(16)=g杆g长

34、度%x(17)=AC杆 AC 长度%x(18)=AD杆 AD 长度%y(1)=theta-22杆与水平方向夹角%y(2)=theta-33杆与水平方向夹角%y(3)=theta-44杆与水平方向夹角%y(4)=theta-ee杆与水平方向夹角%y(5)=theta-ff杆与水平方向夹角%y(6)=theta-gg杆与水平方向夹角%theta2=x(2);theta3=x(3);theta4=x(4);theta5=x(5);theta6=x(6);theta7=x(7);%epsilon=1.0E-6;%f=x(10)*cos(x(1)+x(11)*cos(theta2)-x(18)*cos(

35、x(9)-x(13)*cos(theta4)-x(15)*cos(theta6);x(10)*sin(x(1)+x(11)*sin(theta2)-x(18)*sin(x(9)-x(13)*sin(theta4)-x(15)*sin(theta6); x(10)*cos(x(1)+x(11)*cos(theta2)+x(16)*cos(theta7)-x(17)*cos(x(8)-x(12)*cos(theta3); x(10)*sin(x(1)+x(11)*sin(theta2)+x(16)*sin(theta7)-x(17)*sin(x(8)-x(12)*sin(theta3); x(14

36、)*cos(theta5)+x(15)*cos(theta6)+x(16)*cos(theta7);x(14)*sin(theta5)+x(15)*sin(theta6)+x(16)*sin(theta7); %while norm(f) epsilonJ= -x(11)*sin(theta2) 0 x(13)*sin(theta4) 0 x(15)*sin(theta6) 0;x(11)*cos(theta2) 0 -x(13)*cos(theta4) 0 -x(15)*cos(theta6) 0;-x(11)*sin(theta2) x(12)*sin(theta3) 0 0 0 -x(1

37、6)*sin(theta7);x(11)*cos(theta2) -x(12)*cos(theta3) 0 0 0 x(16)*cos(theta7);0 0 0 -x(14)*sin(theta5) -x(15)*sin(theta6) -x(16)*sin(theta7);0 0 0 x(14)*cos(theta5) x(15)*cos(theta6) x(16)*cos(theta7);dth=inv(J)*(-1.0*f);theta2=theta2+dth(1);theta3=theta3+dth(2);theta4=theta4+dth(3);theta5=theta5+dth(

38、4);theta6=theta6+dth(5);theta7=theta7+dth(6);f=x(10)*cos(x(1)+x(11)*cos(theta2)-x(18)*cos(x(9)-x(13)*cos(theta4)-x(15)*cos(th eta6);x(10)*sin(x(1)+x(11)*sin(theta2)-x(18)*sin(x(9)-x(13)*sin(theta4)-x(15)*sin(t heta6);x(10)*cos(x(1)+x(11)*cos(theta2)+x(16)*cos(theta7)-x(17)*cos(x(8)-x(12)*c os(theta3

39、);x(10)*sin(x(1)+x(11)*sin(theta2)+x(16)*sin(theta7)-x(17)*sin(x(8)-x(12) *sin(theta3);x(14)*cos(theta5)+x(15)*cos(theta6)+x(16)*cos(theta7);x(14)*sin(theta5) +x(15)*sin(theta6)+x(16)*sin(theta7);norm(f)end;y(1)=theta2;y(2)=theta3;y(3)=theta4;y(4)=theta5;y(5)=theta6;y(6)=theta7;此函数模块的输入量为杆1与水平方向的夹角、

40、其余各杆与水平方向夹角的估计 值以及杆的杆长及AC、AD两个收入参量的杆长和角度的估计值，输出参量为2, 3, 4, E,F,G杆与水平方向的夹角。7R六杆III级机构在图所示位置，估计构件2, 3, 4, e, f, g的角位移为%=5.9341rad, %=1.9199rad,禹=1.9199rad, Oe=0, 0f=2.3562rad, Og=0.3491。输入参 数 x=40*pi/180 340*pi/180 110*pi/180 110*pi/180 0 135*pi/180 20*pi/180 atan(350/700) atan(350/250) 120 400 300 30

41、0 450 180 350 sqrt(350A2+700A2) sqrt(350人2+250人2),解得 %=-0.3725rad, %=-1.2735rad, 04=-1.2735rad, 0e=3.1416rad, Of=-0.8040rad, %=0.3794rad。运用牛顿一辛普森法进行角速度分析&2&34g&f0.-g Jr sin(0 )r cos(0 )r sin(0 )r cos(0 )2 0 2000r sin(0 )r cos(0 )r sin(0 )r cos(0 )00000000e - sin(0 )e - cos(0 )ef - sin(O )f - cos(&f)

42、 0 f0f - sin(七) f - cos(& j00g - sin(0 )g - cos(0 )g - sin(0：)g - cos(0g)-1r sin 0r cos 0 r sin 0.r cos 01 0 10对式(2.10)-式(2.12)求导并展开成矩阵形式为:(2.18)根据式(2.18)编写M函数如下:function y=r6vel(x)%x(1)=theta-1%x(2)=theta-2%x(3)=theta-3%x(4)=theta-4%x(5)=theta-e%x(6)=theta-f%x(7)=theta-g%x(8)=dtheta-1%x(9)=r1%x(10)

43、=r2%x(11)=r3杆1与水平方向夹角 杆2与水平方向夹角 杆3与水平方向夹角 杆4与水平方向夹角 杆e与水平方向夹角 杆f与水平方向夹角 杆g与水平方向夹角 杆1角速度 杆1长度 杆2长度 杆3长度%x(12)=r4杆4长度%x(13)=e杆e长度%x(14)=f杆f长度%x(15)=g杆g长度%y(1)=dtheta-2杆2角加速度%y(2)=dtheta-3杆3角加速度%y(3)=dtheta-4杆4角加速度%y(4)=dtheta-e杆e角加速度%y(5)=dtheta-f杆f角加速度%y(6)=dtheta-g杆g角加速度A= -x(10)*sin(x(2) 0 x(12)*si

44、n(x(4) 0 x(14)*sin(x(6) 0;x(10)*cos(x(2) 0 x(12)*cos(x(4) 0 x(14)*sin(x(6) 0;-x(10)*sin(x(2) x(11)*sin(x(3) 0 0 0 -x(15)*sin(x(7);x(10)*cos(x(2) -x(11)*cos(x(3) 0 0 0 x(15)*cos(x(7);0 0 0 -x(13)*sin(x(5) -x(14)*sin(x(6) -x(15)*sin(x(7);0 0 0 x(13)*cos(x(5) x(15)*cos(x(6) x(15)*cos(x(7);B=x(10)*sin(x

45、(1);-x(10)*cos(x(1);x(10)*sin(x(1);-x(10)*cos(x(1);0;0*x(8); y=inv(A)*B;此函数模块输入量为各杆与水平方向的角度以及杆1的角速度，输出参数为2, 3, 4, E,F,G杆的角加速度。图3所示机构，由位移分析计算出的各杆角度和曲柄1的角 速度为 10rad/s，则输入参数为：x= 40*pi/180 -0.3725-1.2735-1.27353.1416-0.8040 0.3794 10 120 400 300 300 450 180 350，代入上面的 M 文件，求得 2，3，4, e，f，g 杆的角速度依次分别为-3.49

46、rad/s，-4.5298rad/s，-4.5298rad/s，0rad/s，0rad/s， 0rad/s。2.4虫六杆皿级机构运动学仿真模型及结果2.4.1 7公六杆皿级机构图3所示是由原动件(曲柄1)和1个6RIII级杆组所组成的7R六杆III级机构， 复数向量坐标如图14 1所示，各构件的尺寸为的r =120mm, r =400mm, r =300mm, 旦.，.旦】、，VHJA，2，3，r4=300mm，ReD=250mm，FG=450mm，GE=180mm，EF=350mm，ImD=350mm， ReC=700mm，ImC=350mm，构件1以等角速度10rad/s逆时针方向回转，试

47、求构件2 和构件3的位移、速度、加速度。2.4.2 7R六杆山级机构MATLAB运动学仿真模型7R六杆III级机构MATLAB运动学仿真模型如图所示，在图中各积分 模块的初值是以曲柄1的幅角为0.72rad和角速度等于10rad/s逆时针方向回转时，相 应各个构件的位移、速度的瞬时值，2个MATLAB函数模块分别为crank.m和r6ki.m, 其中crank.m函数模块的输入参数为曲柄的长度、角位移、角速度和角加速度；输出 参数为曲柄端部(转动副B)的加速度的水平分量和垂直分量;r6ki.m函数模块的输入 参数为构件2、构件3的角位移和角速度，构件2、构件3和构件4的杆长，构件5 的3个边长

48、，构件2、构件3、构件4的角位移和角速度，构件5的3个边向量的角 位移和3个转动副B,C,D的加速度；输出参数为构件2、构件3和构件4的角加速度， 构件5的3个边向量的角加速度和转动副E,F,G的加速度。每个数据线上标注了相应 变量，常量模块放置了各个构件的尺寸，长度分别为m，角度单位为rad。设置仿真 时间为1s，仿真结果输出到工作空间变量simout中，输出格式为array,求解器选用 ode45，步长选用变步长。2.4.3 7R六杆1级机构MATLAB运动学仿真结果由于曲柄转速为10rad/s,因此每转动1周的时间是0.628s,用绘图命令 plot(tout,simout(:,1)，p

49、lot(tout,simout(:,2)，plot(tout,simout(:,5)，plot(tout,simout(:,6)， plot(tout,simout(:,9)，plot(tout,simout(:,10)，plot(tout,simout(:,3)，plot(tout,simout(:,4) 绘制出构件2和构件3的位移、速度、加速度，构件4的位移、向量e的位移，如图 所示。从该图中可以看出这些参数也都是周期变化的。从图3所给出的各个构件的尺寸可以看出，由构件3, 4, 5, 6构成平行四边形， 因此构件5就作平动，复数向量e,f,g的角位移为常量、角速度为零。从图6 (g)中

50、看出复数向量e仿真结果确实如此。同时构件3, 4的角位移、角速度、角加速度应 该相同，比较图6 3)和(h)曲线也相同，这两组也说明了所推导的6RI级杆组 的运动学仿真公式及相应的M函数和仿真模型是正确的。ootheta-2dtheta-4theta-3dthetatheta-4ddrt:heta-2 1/s 1/sthms:zrLdthets-2 1/sdthela-2zzretdthets-3thets-3 1/s 1/sdtheta-3：lTEtthets-4dthets-4theta-2 1/s 1/sdtheta-4theta-3:zretdthets-ethets-e 1/stli

51、eta-4dtheta-f:rtdthets-fthmsdditfieta-2dditfieta-2theta-iTdkfthela-3lEddEthetasdtheta-2祠出目dtheta-3rEki.mlmddFdtlieti-4 1/s 1/s祠 ddGdtlretMdthets-gthets-glmddGdthela-f出亦5ReddEdthela-gilmdldlEReddBRefddFlsimautllmddFlcrsnk.mReddCReddGTo WDikspsoellmdtfC0 明赤：lmddGReddDlmddCDlmddDReddDMATLA.EFunctionMAT

52、LAB Functionthets-1 dtheta-Tthets-2 - I ., ii1- 1.S1/s0.4IntegrstDiE-0.3sim-cutTo Wc-iteps oeF 1/Sr* 1/sdthets-1Dddthets-1lmddDddtheta-4图6 （a） 构件2的角位移（纵坐标表示角位移的大小，单位为rad；横坐标表示时间，单位为s。）图6（b）构件3的角位移（纵坐标表示角位移的大小，单位为rad；横坐标表示时间，单位为s。）图6 （c） 构件3的角速度（纵坐标表示角速度的大小，单位为rad/s；横坐标表示时间，单位为s。）图6（d） 构件2的角速度（纵坐标表示角

53、位移的大小，单位为rad/s；横坐标表示时间，单位为s。）图6 （e）构件2的角加速度（纵坐标表示角加速度的大小，单位为rad/s2；横坐标表示时间，单位为s。）图6（f）构件3的角加速度（纵坐标表示角加速度的大小，单位为rad/s2；横坐标表示时间，单位为s。）4.53.52.500 10.20.30.40.5 OS 0.7 O.S 0.91图6 （g） 向量e的角位移（纵坐标表示角位移的大小，单位为rad；横坐标表示时间，单位为s。）图6（h） 构件4的角位移（纵坐标表示角位移的大小，单位为rad；横坐标表示时间，单位为s。）37R六杆III级机构动力学仿真3.1曲柄原动件动力学数学模型的

54、建立曲柄原动件动力学数学分析图7曲柄的受力模型如图7所示，已知曲柄AB向量的模ri为常数，幅角危为变量，质心到转动副 A的距离为rci，质量为mi,绕质心转动惯量为Ji,作用于质心上的外力为Fxi和Fyi、 外力矩为Mi,曲柄与机架联接，转动副A的约束反力为Rxa和Rya,驱动力矩为 Ml。由理论力学可得： TOC o 1-5 h z RA - R b + F = m Re，S（3.1）R - R + F -m g = m ImS（3.2）yA yB yi ii iM + M + R r sin 0 - R r cos 0 +1 i xA ci i yA ci iR （r - r ）sin0

55、- RyB（r - r ）cos0 =（3.3）xB i ciii ciiJ $ i i由运动学知识可推得：ReS = Re A+ r 0 cos（0 +兀 /2） + r 02 cos（0 +兀）（3.4）ici i ici iiIms = ImA+ r 0 sin（0 +兀/2） + r 02 sin（0 +兀）（3.5）ici i ici ii将式（3.4）、式（3.5）代入式（3.1）、式（3.2）,并与式（3.3）合并得:RxAR睥M1m R A+ m r cos(0 +兀 / 2) + m r 0 2 cos(0 +兀)F + Ri ei ci iii ci iixi xBm R

56、A+ m r 0 sin(0 +兀 / 2) + m r 0 2 sin(0 +兀)F + R + m gi ei ci iii ci iiyi yB iJ 0 R r sin0 + R r cos0 R (r r )sin0 + R (r r ) cos0 Mi i xA ci i yA ci i xB i cii yB i cii i(3.6)曲柄MATLAB动力学仿真模块M函数根据式(3.6)编写曲柄原动件MATLAB的M函数如下:曲柄与水平方向夹角曲柄角速度曲柄角加速度转动副B约束反力水平分量 转动副B约束反力垂直分量 转动副A约束反力水平分量 转动副A约束反力垂直分量 转动副A的驱动

57、力矩function y=crankdy(x)%x(1)=theta-i%x(2)=dtheta-i%x(3)=ddtheta-i%x(4)=RxB%x(5)=RyB%y(1)=RxA%y(2)=RyA%y(3)=M1 g=9.8ri=0.4;rci=0.2;mi=1.2;Ji=0.016;Fxi=0;Fyi=0;Mi=0;ReddA=0;ImddA=0;y(1)=mi*ReddA+mi*rci*x(3)*cos(x(1)+pi/2)+mi*rci*x(2)2*cos(x(1)+pi)-Fxi+x(4); y(2)=mi*ImddA+mi*rci*x(3)*sin(x(1)+pi/2)+mi*

58、rci*x(2)2*sin(x(1)+pi)-Fyi+x(5)+mi*g;y(3)=Ji*x(3)-y(1)*rci*sin(x(1)+y(2)*rci*cos(x(1)-x(4)*(ri-rci)*sin(x(1)+x(5)*(ri-rci)*cos(x(1)-Mi;此函数模块转用于求动副A的约束反力和曲柄上作用的驱动力矩。输入参数是 曲柄原动件的角位移、角速度和角加速度以及转动副B的反作用力；输出参数是转 动副A的约束反力和曲柄上作用的驱动力矩。3.2 6Rm级杆组动力学数学模型的建立3.2.16Rffl级杆组动力学数学分析由3个外转动副(B,C,D)和3个内转动副(E,F,G)组成的6R

59、III级杆组如图3.2.1(a) 所示，其中具有2个转动副的3个构件：BE构件、FC构件和GD构件的受力情况如 图3.2.1(b)、(c)、(d)所示。除不受驱动力矩外，其受力分析同曲柄的受力 分析是一样的，直接给出公式为：R+ R= m ReB+ m r cos(0+兀 / 2) + m r 0 2 cos(0+兀)一F(3.7)xB xE ii ci iii ci iixiR+ R= m ImB+ m r 0 sin(0+ 兀 / 2) + m r 02sin(0+兀)一 F+ m (3.8)yB yE ii ci iii ci iiyi igR r sin 0 - R r cos0 -

60、R (r r )sin0 + R (r r )cos0 = J 0 - MxB ci i yB ci i xE i cii yE i cii i i iR + R = m Re C+ m r 0, cos(0 +兀 / 2) + m r 0 2 cos(0 +兀)-FxCxF jj cj jjj cj jjxjR + R =m ImC+ m r 0* sin(0 +兀 / 2) + m r 0 2 sin(0 +兀)-F + m gyC yF jj cj j jj cj jjxj jR r sin0 - R r cos0 - R (r - r )sin0 + R (r - r )cos0 =