关 键 词：

机械毕业设计全套

资源描述：

JXFZ01-001@7R六杆Ⅲ级机构的动态仿真,机械毕业设计全套

内容简介：

1 目 录 1 绪论 . (2) 1.1 引言 . (2) 1.2 平面连杆机构及杆组概述 . (2) 1.3 进行杆组系统仿真的意义 . (3) 1.4 仿真软件的发展状况与应用 . (3) 1.5 MATLAB 概述 . (3) 2 7R 六杆级机构运动学仿真 . (5) 2.1 曲柄原动件运动学分析 . (5) 2.2 6R级杆组运动学分析 . (6) 2.3 7R 六杆级机构 MATLAB 仿真积分模块初值的确定 . (11) 2.4 7R 六杆级机构运动学仿真模型及结果 . (16) 3 7R 六杆级机构动力学仿真 . (23) 3.1 曲柄原动件动力学数学模型的建立 . (23) 3.2 6R级杆组动力学数学模型的建立 . (25) 3.3 需要引用的函数 . (30) 3.4 7R 六杆级机构运动学仿真模型及结果 . (32) 4 结论 . (39) 参考文献 . (40) 致谢 . (41) nts 2 1 绪论 1.1 引言 大学的四年生活，通过老师的讲解和我自己的学习，我收获了很多，我也深深的喜欢上了机械这个行业，对机械加工和制造方面尤为感兴趣，我觉得通过自己的努力和思考来改变工艺规程来提高生产效率，提高经济效益很有成就感。我所研究的 课题就是给了这样的机会我可以通过我的努力来优化工艺规程，提高经济效益。此次毕业设计，是在我们学完了机械制造工艺学、工艺装备设计等课程，进行了生产实习之后，进行的一个重要的实践性环节。这要求我们把所学的工艺理论和实践知识，在实际的工艺、夹具设计中综合地加以运用，这有助与提高了我们分析和解决生产实际问题的能力，为以后从事相关的技术工作奠定的基础。 1.2 平面连杆机构及杆组概述 平面连杆机构是将各构件用转动副或移动副联接而成的平面机构。最简单的平面连杆机构是由四个构件组成的，简称平面四杆机构。它的应用非常广泛， 而且是组成多杆机构的基础。 全部用回转副组成的平面四杆机构称为铰链四杆机构。仅能在某一角度摆动的连架杆，称为摇杆。对于铰链四杆机构来说，机架和连杆总是存在的，因此可按照连架杆是曲柄还是摇杆，将铰链四杆机构分为三种基本型式：曲柄摇杆机构、双曲柄机构和双摇杆机构。 在实际机械中，平面连杆机构的型式是多种多样的，但其中绝大多数是在铰链四杆机构的基础上发展和演化而成。 如 曲柄滑块机构 、 导杆机构 等。 任何机构都是由原动件、机架和从动件构成的系统。由于机架的自由度为零，一般每个原动件的自由度为 1，且根据运动链成为机构的条 件可知，机构的自由度与原动件为应相等，所以，从动件系统的自由度数必为零。机构的从动件系统还可以进一步分解成若干个不可再分的自由度为零的构件组合，这种组合称为杆组。设 n 表示活动构件数， PL 表示低副个数，根据 n 的取值不同，村级可分为级杆组和级杆组。其中级杆组分为 5 种： RRR级杆组、 RRP级杆组、 RPR级杆组、 PRP级杆组以及 RPP级杆组。 任何机构都可以看作是由若干个基本村级依次联接于原动件和机架而构成的，这就是所谓机构的组成原理。通常，把由最高级别为级杆组的基本杆组构成的机构称为级机构；把 最高级为级杆组的基本杆组构成的机构称为级机构。 nts 3 1.3 进行杆组系统仿真的意义 系统仿真是建立在控制理论、相似理论、信息处理技术和计算机初等理论基础之上的，以计算机和其他专用物理效应设备为工具，利用系统模型对真实或假设的系统进行试验，并借助于专家的经验知识、统计数据和信息资料对实验结果进行分析研究，进而做出决策的一门综合的实验性学科 。 仿真技术是分析、研究各种系统，尤其是复杂系统的重要工具。随着 机械行业 的迅速发展， 对研究、设计的机械设备越来越复杂 ， 用于制造各种零件的材料 价格越来越昂贵， 不可能每一步都采 取试制再修改的方法进行设计， 采用仿真的方法可以在一定程度上克服 这种不足 的不足 ，降低研究成本，提高效率 。 而连杆机构作为常见的传动机构，对其进行运动学和动力学仿真，建立起基本杆组模块的仿真模型，无疑对日后的设计大有裨益。 一般机构的运动分析，使用 Quik BASIC语言或 Fortran语言编写程序进行计算，其缺点“透明性”差，修改麻烦等而用 MATLAB对机构进行运动仿真，利用 MATLAB的 simulink仿真模型的数据可视化的特点，就可以很容易观察到运动参数是如何变化的，极其简便同时，用 MATLAB建立和修 改仿真模型具有方便、快捷、很容易扩展等优点 MATLAB仿真求解器提供很多解不同微分方程的方法，可以根据不同的微分方程类型选择相应的求解方法 机构的动力学分析，由已知工作阻力，求出运动副的约束反力和驱动力（或力矩），为选择和设计轴承和零部件强度的计算及选择原动机提供理论依据。 1.4 仿真软件的发展状况与应用 早期的计算机仿真技术大致经历了几个阶段： 20 世纪 40 年代模拟计算机仿真；50 年代初数字仿真； 60 年代早期仿真语言的出现等。 80 年代出现的面向对象仿真技术为系统仿真方法注入了活力。我国早在 50 年代就开 始研究仿真技术了，当时主要用于国防领域，以模拟计算机的仿真为主。 70 年代初开始应用数字计算机进行仿真4。随着数字计算机的普及，近 20 年以来，国际、国内出现了许多专门用于计算机数字仿真的仿真语言与工具，如 CSMP， ACSL， SIMNOM， MATLAB/Simulink， Matrix/System Build， CSMP-C 等。 1.5 MATLAB 概述 MATLAB 是国际上仿真领域最权威、最实用的计算机工具。它是 MathWork 公司于 1982 年推出的一套高性能的数值计算和可视化数学软件，被誉为“ 巨人肩上的nts 4 工具”。 MATLAB 是一种应用于计算技术的高性能语言。它将计算，可视化和编程结合在一个易于使用的环境中，此而将问题解决方案表示成我们所熟悉的数学符号，其典型的使用包括 : .数学计算 .运算法则的推导 .模型仿真和还原 .数据分析，采集及可视化 .科技和工程制图 .开发软件，包括图形用户界面的建立 MATLAB 是一个交互式系统，它的基本数据元素是矩阵，且不需要指定大小。通过它可以解决很多技术计算问题，尤其是带有矩阵和矢量公式推导的问题，有时还能写入非交互式语言如 C 和 Fortran 等。 MATLAB的名字象征着矩阵库。它最初被开发出来是为了方便访问由 LINPACK和 EISPAK 开发的矩阵软件，其代表着艺术级的矩阵计算软件。 MATLAB 在拥有很多用户的同时经历了许多年的发展时期。在大学环境中，它作为介绍性的教育工具，以及在进阶课程中应用于数学，工程和科学。在工业上它是用于高生产力研究，开发，分析的工具之一。 Simulink 概述 Simulink 是用于仿真建模及分析动态系统的一组程序包，它支持线形和非线性系统，能在连续时间，离散时间或两者的复合情况下建模。系统也能采用复合速率，也就是用不同 的部分用不同的速率来采样和更新。 Simulink 提供一个图形化用户界面用于建模，用鼠标拖拉块状图表即可完成建模。在此界面下能像用铅笔在纸上一样画模型。相对于以前的仿真需要用语言和程序来表明不同的方程式而言有了极大的进步。 Simulink 拥有全面的库，如接收器，信号源，线形及非线形组块和连接器。同时也能自己定义和建立自己的块。模块有等级之分，因此可以由顶层往下的步骤也可以选择从底层往上建模。可以在高层上统观系统，然后双击模块来观看下一层的模型细节。这种途径可以深入了解模型的组织和模块之间的相互作用。 nts 5 2 7R六杆级机构运动学仿真 2.1 曲柄原动件运动学分析 2.1.1 曲柄原动件运动学数学模型的建立 如图 1所示，在复数坐标系中，曲柄 AB复向量的模 rj为常数、幅角 j为变量，通过转动副 A与机架连接，转动副 A的复向量的模 ri为常量、幅角 i为常量，曲柄 AB端点 B的位移、速度和加速度的推导如下： jijijjjijjjjjiiererrABerrerrA , （ 2.1） 将方程 2.1 两边对时间 t 求两次导数得： )2/()2/( jj jjjjjj ererB （ 2.2） 由式 2.2 写成矩阵形式有 )s in ()2/s in ()c o s ()2/c o s (ImRe22jjjjjjjjjjjjrrrrBB （ 2.3） 2.1.2 曲柄 MATLAB 运动学仿真模块 M 函数 根据式 (2.3)编写曲柄原动件 MATLAB 的 M 函数如下： function y=crank(x) %x(1)=rj 曲柄杆长 %x(2)=thetaj 曲柄与水平方向夹角 %x(3)=dthetaj 曲柄角速度 %x(4)=ddthetaj 曲柄角加 速度 %y(1)=ReddB 转动副 B 加速度实轴分量 图 1 曲柄的复数坐标系 nts 6 %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.2 6R级杆组运动学分析 2.2.1 6R级杆组运动学数学模型的建立 如图 2所示，在复数坐标系中，由 3个外转动副 (B,C,D)和 3个内转动副 (E,F,G),4个构件 (BE,CF,DG和 EFG)构成 1个 6R级杆组，构件 BE,CF,DG的长度分别为 ri， rj， rk构件EFG的 3个边为 e， f， g，方向如图所示，规定所有复向量与实轴正方向逆时针夹角为，并用相应的下标来区别，用 B,C,D,E,F和 G分别表示该转动副的复数坐标，则各个构件的运动参数推导如下： kjijkjjjierDGerCFerBE（ 2.4） gfejjjgeEFgfeGEfeeFGe（ 2.5） 图 2 6R级杆组的位置参数 nts 7 将式（ 2.4）代入式（ 2.5）并整理得： BDfeererDCeeererCBgeererfkiekjgjijjkjijjkjjjjjji（ 2.6） 将式 (2.4)至式 (2.6)三式合并成矩阵得： BDDCCBfeerereeerergeererfeerereeerergeerergfekjijjkjijjkjjjjjjigfekjijjkjijjkjjjjjjifkiekjgjifkiekjgji222222)()()()()()()()()()2/()2/()2/()2/()2/()2/()2/()2/()2/(000000000000000000（ 2.7） 将式 (2.7)展开整理得： 0)2s i n (0)2s i n (0)2s i n (0)2c o s (0)2c o s (0)2c o s (00)2s i n ()2s i n ()2c o s (000)2c o s ()2c o s ()2c o s (0)2s i n (000)2c o s ()2s i n ()2c o s (000)2c o s ()2c o s (fkkiifkkiiekkiiekkiigjjiigjjiifrrfrrerrerrgrrgrrnts 8 BDBDDCDCCBCBfrrfrrerrerrrrrrrrgfekjifkkiifkkiiekkjjekkjjiijjiiiijjiigfekjiImImReReImImReReImImReRe0)c o s (0)c o s (0)s i n (0)c o s (0)c o s (0)c o s (00)s i n ()s i n ()s i n (000)c o s ()c o s ()c o s (0)c o s (000)s i n ()s i n ()c o s (000)c o s ()c o s (222222（ 2.8） 点 E， F， G 的加速度分别为 222)s i n ()c o s ()2s i n ()2c o s (ImReImRe)s i n ()c o s ()2s i n ()2c o s (ImReImRe)s i n ()c o s ()2s i n ()2c o s (ImReImRekkkkkkkkjjjjjjjjiiiiiiiirrDDGGrrCCFFrrBBEE（ 2.9） 2.2.2 6R级杆组 MATLAB 运动学仿真模块 M 函数 根据式 (2.9)编写 6R级杆组 MATLAB 的 M 函数如下： function y=R6ki(x) %x(1)=ri BE 杆长 %x(2)=rj CF 杆长 %x(3)=rk DG 杆长 nts 9 %x(4)=e FG 杆长 %x(5)=f GE 杆长 %x(6)=g EF 杆长 %x(7)=theta-i BE 杆与水平方向夹角 %x(8)=theta-j DF 杆与水平方向夹角 %x(9)=theta-k DG 杆与水平方向夹角 %x(10)=theta-e FG 杆与水平方向夹角 %x(11)=theta-f GE 杆与水平方向夹角 %x(12)=theta-g EF 杆与水平方向夹角 %x(13)=dtheta-i BE 杆角速度 %x(14)=dtheta-j EF 杆角速度 %x(15)=dtheta-k DG 杆角速度 %x(16)=dtheta-e GE 杆角速度 %x(17)=dtheta-f GE 杆角速度 %x(18)=dtheta-g EF 杆角速度 %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-i BE 杆角加速度 %y(2)=ddtheta-j CF 杆角加速度 %y(3)=ddtheta-k DG 杆角加速度 %y(4)=ddtheta-e FG 杆角加速度 %y(5)=ddtheta-f GE 杆角加速度 %y(6)=ddtheta-f EF 杆角加速度 %y(7)=ReddE 转动副 E 加速度实轴分量 %y(8)=ImddE 转动副 E 加速度虚轴分量 %y(9)=ReddF 转动副 F 加速度实轴分量 %y(10)=ImddF 转动副 F 加速度虚轴分量 nts 10 %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(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(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) 0 -x(5)*sin(x(11)+pi) 0; b1=c*x(13)2;x(14)2;x(15)2;x(16)2;x(17)2;x(18)2; 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)*cos(x(7)+pi/2)+x(1)*x(13)2*cos(x(7)+pi); y(8)=x(20)+x(1)*ddtheta(1)*sin(x(7)+pi/2)+x(1)*x(13)2*sin(x(7)+pi); y(9)=x(21)+x(2)*ddtheta(2)*cos(x(8)+pi/2)+x(2)*x(14)2*cos(x(8)+pi); y(10)=x(22)+x(2)*ddtheta(2)*sin(x(8)+pi/2)+x(2)*x(14)2*sin(x(8)+pi); y(11)=x(23)+x(3)*ddtheta(3)*cos(x(9)+pi/2)+x(3)*x(15)2*cos(x(9)+pi); y(12)=x(24)+x(3)*ddtheta(3)*sin(x(9)+pi/2)+x(3)*x(15)2*sin(x(9)+pi); 这个模块用于求级杆组中各杆的加速度的水平及垂直分量。输入参数为构件 2、nts 11 构件 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 六杆级机构 MATLAB 仿真积分模块初值的确定 2.3.1 运用牛顿 辛普森法进行角位移分析 图 3 所示是由原动件（曲柄 1）和一个 6R级杆组所组成的 7R 六杆级机构，复数向量坐标亦如图所示，各构件的尺寸为 r1=120mm， r2=400mm， r3=300mm，r4=300mm， ReD=250mm， FG=450mm， GE=180mm， EF=350mm， ImD=350mm，ReC=700mm， ImC=350mm，构件 1 以等角速度 10rad/s 逆时针方向回转，试求构件 2和构件 3 的位移、速度和加速度。 由图 3 可列以下三个方程： AB+BEAD-DG EG=0， 即 r1+r2-AD-r4-f=0 (2.10) AB+BE+EF-AC-CF=0 即 r1+r2+g-AC-r3=0 (2.11) EF+FG+GE=0, 即 g+e+f=0 (2.12) 由复向量坐标，可写出式 (2.10)、式 (2.11)及式 (2.12)的角位移方程为： 0421 421 fAD jjjjj eferA Deerer （ 2.13） 图 3 7R 六杆级机构 nts 12 0321 321 jjjjj erA C eegerer ACg (2.14) 0 gfe jjj egefee (2.15) 将式 (2.13)、式 (2.14)、式 (2.15)展开，整理得 : 0)s i n ()s i n ()s i n (),(0)c o s ()c o s ()c o s (),(0)s i n ()s i n ()s i n ()s i n ()s i n (),(0)c o s ()c o s ()c o s ()c o s ()c o s (),(0)s i n ()s i n ()s i n ()s i n ()s i n (),(0)c o s ()c o s ()c o s ()c o s ()c o s (),(33221132332211324422114244221142gfegfegfegfegACggACgfADffADfgfefgfefgrACrrfgrACrrffrADrrffrADrrf(2.16) 由式 (2.16)求出雅可比矩阵为： )c o s ()c o s ()c o s (000)s i n ()s i n ()s i n (000)c o s (000)c o s ()c o s ()s i n (000)s i n ()s i n (0)c o s (0)c o s (0)c o s (0)s i n (0)s i n (0)s i n (3322332244224422gfegfeggffgfegfegrrgrrfrrfrrJ(2.17) 根据式 (2.16)、式 (2.17)，由牛顿 辛普森求解方法得编制 M 函数如下： function y=r6posi(x) %x(1)=theta-1 杆 1 与水平方向夹角 %x(2)=theta-2 杆 2 与水平方向夹角（估计量） %x(3)=theta-3 杆 3 与水平方向夹角（估计量） %x(4)=theta-4 杆 4 与水平方向 夹角（估计量） %x(5)=theta-e 杆 e 与水平方向夹角（估计量） %x(6)=theta-f 杆 f 与水平方向夹角（估计量） %x(7)=theta-g 杆 g 与水平方向夹角（估计量） %x(8)=theta-AC AC 与水平方向夹角 %x(9)=theta-AD AD 与水平方向夹角 %x(10)=r1 杆 1 长度 %x(11)=r2 杆 2 长度 nts 13 %x(12)=r3 杆 3 长度 %x(13)=r4 杆 4 长度 %x(14)=e 杆 e 长度 %x(15)=f 杆 f 长度 %x(16)=g 杆 g 长度 %x(17)=AC 杆 AC 长度 %x(18)=AD 杆 AD 长度 %y(1)=theta-2 2 杆与水平方向夹角 %y(2)=theta-3 3 杆与水平方向夹角 %y(3)=theta-4 4 杆与水平方向夹角 %y(4)=theta-e e 杆与水平方向夹角 %y(5)=theta-f f 杆与水平方向夹角 %y(6)=theta-g g 杆与水平方向夹角 % 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(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)*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) epsilon nts 14 J= -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(16)*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(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(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)*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 与水平方向的夹角、其余各杆与水平方向夹角的估计值以及杆的杆长及 AC、 AD 两个收入参量的杆长和角度的估计值，输出参量为 2， 3，4， E,F,G 杆与水平方向的夹角。 7R 六 杆级机构在图 1.3.1 所示位置，估计构件 2， 3， 4， e， f， g 的角位移为nts 15 2=5.9341rad， 3=1.9199rad， 4=1.9199rad， e=0， f=2.3562rad， g=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 300 450 180 350 sqrt(3502+7002) sqrt(3502+2502)，解得2=-0.3725rad， 3=-1.2735rad， 4=-1.2735rad， e=3.1416rad， f=-0.8040rad， g=0.3794rad。 2.3.2 运用牛顿 辛普森法进行角速度分析 对式 (2.10)-式 (2.12)求导并展开成矩阵形式为： (2.18) 根据式 (2.18)编写 M 函数如下： function y=r6vel(x) %x(1)=theta-1 杆 1 与水平方向夹角 %x(2)=theta-2 杆 2 与水平方向夹角 %x(3)=theta-3 杆 3 与水平方向夹角 %x(4)=theta-4 杆 4 与水平方向夹角 %x(5)=theta-e 杆 e 与水平方向夹角 %x(6)=theta-f 杆 f 与水平方向夹角 %x(7)=theta-g 杆 g 与水平方向夹角 %x(8)=dtheta-1 杆 1 角速度 %x(9)=r1 杆 1 长度 %x(10)=r2 杆 2 长度 %x(11)=r3 杆 3 长度 1111111111332233224422442243200c o ss i nc o ss i n)c o s ()c o s ()c o s (000)s i n ()s i n ()s i n (000)c o s (000)c o s ()c o s ()s i n (000)s i n ()s i n (0)c o s (0)c o s (0)c o s (0)s i n (0)s i n (0)s i n (rrrrgfegfegrrgrrfrrfrrgfegfeggffgfents 16 %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)*sin(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(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.2735 3.1416 -0.8040 0.3794 10 120 400 300 300 450 180 350，代入上面的 M 文件，求得 2， 3， 4，e， f， g 杆的角速度依次分别为 -3.49rad/s， -4.5298rad/s， -4.5298rad/s， 0rad/s， 0rad/s，0rad/s。 2.4 7R六杆级机构运动学仿真模型及结果 2.4.1 7R六杆级机构 图 3 所示是由原动件（曲柄 1）和 1 个 6R级杆组所组成的 7R 六杆级机构，复数向量坐标如图 1.4.1 所示，各构件的尺寸为的 r1=120mm， r2=400mm， r3=300mm，r4=300mm， ReD=250mm， FG=450mm， GE=180mm， EF=350mm， ImD=350mm，ReC=700mm， ImC=350mm，构件 1 以等角速度 10rad/s 逆时针方向回 转，试求构件 2和构件 3 的位移、速度、加速度。 nts 17 2.4.2 7R 六杆级机构 MATLAB 运动学仿真模型 7R 六杆级机构 MATLAB 运动学仿真模型如图 2.4.2 所示，在图 2.4.2 中各积分模块的初值是以曲柄 1 的幅角为 0.72rad 和角速度等于 10rad/s 逆时针方向回转时，相应各个构件的位移、速度的瞬时值， 2 个 MATLAB 函数模块分别为 crank.m 和 r6ki.m，其中 crank.m 函数模块的输入参数为曲柄的长度、角位移、角速度和角加速度；输出参数为曲柄端部（转动副 B）的加速度的水平分量和垂直分量 ;r6ki.m 函数模块的输入参数为构件 2、构件 3 的角位移和角速度，构件 2、构件 3 和构件 4 的杆长，构件 5的 3 个边长，构件 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 六杆级机构 MATLAB 运动学仿真结果 由于曲柄转速为 10rad/s,因此每转动 1 周的时间是 0.628s,用绘图命令plot(tout,simout(:,1)， plot(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 的位移，如图2.4.3 所示。从该图中可以看出这些参数也都是周期变化的。 从图 3 所给出的各个构件的尺寸可以看出，由构件 3， 4， 5， 6 构成平行四边形