1714_RRR平面连杆机构的动态仿真1

1714_RRR平面连杆机构的动态仿真1,_rrr,平面,连杆机构,动态,仿真 对半刚性连接钢架的非线性有限元分析王新武，洛阳理工学院摘要：在实践中连接钢框架实际显示半刚性变形，可以大大促进结构的整体性能和生产力布局。所以研究半刚性连接钢框架性能是非常必要的。考虑材料组织，几何和材料非线性，刚度，矩阵方程，提出并分析钢考虑半刚性程度，几何非线性和材料非线性相框方案已在Fortran 编译这个文件。使用此方案半刚性连接架二维非线性有限元程序能得到正确执行。内力和半刚性连接钢框架水平位移进行计算后，对其承载能力进行讨论，分析结果与钢结构设计规范的产品进行相比，对结构的极限强度分析后，消除了崩溃特征与塑性铰的出现，它是对半刚性连接钢框架结构设计提出合理建议。最后，本文分析了顶点的摇晃与在钢框架内力的顶点关节活动影响，从而得到结论。 关键词：钢框架，半刚性节点，塑性铰，非线性分析，有限元1.介绍梁柱连接是一个钢框架的整体结构，并且他们的行为影响了它在载荷下的总体表现。在 1994 年的北岭地震期间钢焊接的脆弱性在强大的循环载荷下被彻底的证实了。从那以后，大量的连接已经为高分辨率地震区的钢框架提出了改造和新设计。在那些提议中大多都是那些有高强度的螺栓。那些连接类型提供了诸如低花费，简单切方便的安装程序以及好的控制质量等一些优点，因为 field-welding 是在恶劣环境中最不受欢迎的连接。许多研究已经致力于钢结构框架的非线性弹性分析，正如文章Attallaet,Chen et al ， Galambos中所著。在这些文中，诸多分析方法包括二阶响应，半刚性连接和材料的非线性等都被引用在内。2 钢架的非线性影响2.1 半刚性连接钢架刚度的非线性的影响（1）梁柱连接的分析模型当半刚性连接被用于梁的末端，在钢架的分析中有较强刚度的扳手弹簧便取代了梁柱连接，如图 1：图 1 半刚性连接的构件的结构在图 1 中, AB是梁端关节区角度的正切， RARB梁和柱相关的角度。弹簧的刚度是通过连接的 M-R的关系确定的。在过去，许多 M-R连接的关系都是通过许多半刚性连接的测试而确定的，就像文章Chen et al中提到的一样。为了方便的应用，M- R的关系模型应该选择的精确、简单并且直接，因此，在Kishi-Chen这篇文章中函数M-R 模型的选择方法如公式（1）（2）半刚性连接部件的刚度矩阵当导出半刚性连接构件的刚度矩阵的时候，梁末端的角度仅仅伴随着忽视位移而被考虑。梁两末端的弹簧的刚度分别是 RA 、R B ， 1=A+RA , 2=B+RB ,A、B 之间的距离为 L，所以，这个结果定义如下：弹簧：由公式（1）-(4),M A和 MB 分别为其中，由此可得，当 RA 、 R B 均趋于无穷大时，连接的刚度是刚性的。当考虑梁末端的相对位移时，构件两末端的轴向位移分别为 u1和 u2 ，部件末端的横向位移分别为 v1和 v2 ，因此：构件末端轴向应力：构件末端力矩：构件末端剪应力：由公式（2）-(13),半刚性连接构件的结构刚度矩阵是由公式（14）而导出的：2.2 半刚性连接钢架的几何非线性影响二阶效应包括横向位移关于垂直力的影响（P-）和构件挠度关于轴向力的影响（P-） 。结构的变形将会带来附加内力，同时这个附加内力也会导致结构变形，就这样不断地重复。二阶效应一直以来对钢架的稳定性造成不利的影响。尤其是对于那些有很多层次和那些抗侧刚度不足的钢架，他的影响是更显而易见的。当钢架是由计算机考虑二阶效应的时候，几何刚度矩阵应该结合在单元刚度矩阵中 Gallagher 和 Padlog 提出了如下的一个几何刚度矩阵：其中，P 为构件的轴向应力，当轴向应力是拉应力时，P 为正值。这个单元刚度矩阵考虑半刚性连接和二阶效应为：2.3半刚性连接钢架的非线性材料的影响为了简单地进行钢架分析，它规定所用材料限制在塑料材料类的构件的屈服区域。换句话说，所用材料的所有截面都含有双线性的理想的力矩曲率的弹塑性关系。当截面的力矩低于塑料材料截面的力矩 MP时，截面就表现除了弹性的特性。一旦截面的力矩超出了塑料材料截面的力矩，塑性铰就会起作用并且更多的力矩将不会被截面提供。当结构必须承受被带来的更多载荷的时候，它规定截面力矩要等于常数塑料材料的力矩 MP .那样，铰接的旋转就产生了。带有塑料铰的梁柱的构件末端载荷增量的关系如下面的公式 16 所示：3 计算实例 3.1 计算程序钢架的分析程序考虑到半刚性连接，几何非线性和材料非线性已经被编译于公式翻译语言这本书中。这个程序包括一些子程序。一个是半刚性连接构件的单元刚度矩阵，在承受载荷的时候，矩阵中的每一个因素都应该根据所选择的连接的 M-R 的关系而改变；另一个是几何刚度矩阵，主要考虑由于横向位移关于垂直力的影响（P-）导致每一个单元的内应力和位移的变化。这个矩阵应该以每一次载荷增加之后钢架的变形为基础，一步一步的变化。几何刚度矩阵考虑到半刚性连接的特性，并且随着连接的刚度而改变。 ，同时，塑性铰接理论也用于这个程序，构件末端力矩和塑性力矩作比较，一旦截面力矩超出了这个塑性力矩，塑性铰接便产生了。构件的内应力就重新分配了。3.2 计算实例用上面的程序，分析一个有两个跨度和四个趁此的钢架。图 36 中包含了载荷的分布，单元节点的分布和力矩及一些其他因素的分布。 Kishi-Chen中 M-R的关系模型被采用来模拟连接的特性，并且这个连接类型是顶-座和网格角度的连接。表格一 钢架的物理参数 图三：单元和节点的分布 图四：载荷的分布图五：钢架的力矩 图六：半刚性钢架的力矩和二阶效应表格二 内应力和位移的比较由表格二，可以看出，半刚性连接的梁跨中力矩比刚性连接的梁跨中的力量举要更大。半刚性连接两末端的力矩通常要比刚性连接的梁末端的力矩小一些。考虑到半刚性连接和二阶效应，柱底端和钢架的边缘的力矩会明显的增加。那是因为半刚性连接消弱了梁末端的限制并同时扩大了二阶效应对钢架的影响。在程序的计算过程中，二阶效应和半刚性连接都被考虑在内，横向应力 H 和连接的类型是相关的。但是，在设计代码计算时，横向应力 Hmi被假设为根据刚性连接柱底端的旋转角度的 1/200。H mi要跟大一些，并且不能够正确地反映二阶效应，因此，钢架的边缘和内应力很少用于设计代码。二阶效应的程度随着半刚性连接的改变而改变。当连接的刚度变小的时候，钢架的边缘会更重。4 结论半刚性连接的梁跨中的力矩比刚性连接的梁跨中的力矩要大一些。半刚性连接梁末端的力矩通常要比刚性连接梁末端的力矩要小一些。考虑到半刚性连接和二阶效应，钢架柱底端和钢架的边缘的力矩会明显的增加。二阶效应的程度是随着半刚性连接的改变而改变的。当连接的刚度变小的时候，钢架的边缘会更重。伪 陀一 , , ,卜, ,一一 , , 一一 ,一一一 ,一 ,一一 一 几 , 月 触一, 仃别 始朽 , ,一介 , , , , , , 一 们 触一一 ,一 ,初 而 , , , , ,月 , 林 , 一, , , , 面一 , , 口 。 , 尸, 卜 、 、 。 ” ”一 梦肠一 五 七 刃凡 、 苏 , 。 , , , , ,比 、少、 住了,凡 ,古才、了、城 五 力 艺人 肠 二 百 刀,月产、 几 ,产尸了 、产 、场 峨 月 。 凡 一 , , 一 ,代 , 蟋 人 介、夕了百 才布、场 。, ,一一一夕一七一, 份一 喜大 。 , 二 、 、 、 , 、, 二 几 乙 肚 二 立 色 一 二 二 二 丫 二 二 二 一 二 二 丫 、 。 分 的 , , 峥 的, 一 ” 凡 “ 、 凡 伪, 廿 均 ,、 、 、夕八 尸了 、了飞 、压为 五 亿 一一 石 力 艺 一了 了 、 , ,蟋 一 、脱 、 , 一 均。 一、 ,产、少,气几几了、 ,么一 , “ 。 “ 、 号一 “, , “ , ,号 “ “ 。 “ 。 号、百 , , 百 。 十 百 , 万 ” , 、, 一 百 “ 百 。 万 “ , 一 百 , 百 “刀于卜 , 一乙 咬因 况 “ ,凡 、 鲁 凡 凡 号一 五 五 月一凡、 、” 一 氏 线 蜘 万 一 热 叼 万 况, 二 鲁、百 “ 蕊 , , ,左 君 凡 于一 凡 、 号初 一一幼 一叮 ,血伪 ,伪 月 五 叙 脚 七 切 就 “ 】斤 月 免 】 】 , 吐恤 因 盆笑 功幻一 一 八一 一, ,一 一幻 一 幻 “ 因月 魁 尸 理 户田 叭 , 协,一 一,一叭城城城嶙城二 、 、厂 ,卜一一匀从忆叭帆帆田 田 叭 一 ,州 比 七甩 伪 认而 一 , ,一 , 伪 议 , 池出伪 田 甩一 , 伪 , 田 油 ,面 田 肚 , , 恤, 一 一,一 一 , 一, , , , , , , 一 , 一 , 一 。 二乙乙。 匆匆 。 妙妙又又 岁岁 使 产 , 。 叭甘甘甘甘二 上 工 以吠 可 班班班 ,月月月月月月月月月月月月月月月月月月月月月吐吐寸寸寸寸寸寸寸寸寸寸寸寸寸寸寸寸寸寸寸寸寸呢 可 旅旅旅 减减心心心心心心心心心心心心心心心心心心心心 含含上 工 上 上 , 工 二 以 日日 峨 咋咋成 可 筑筑筑筑儿 工 人又 二 翻田岛岛田忍傲傲 左左 玉 以以 肠肠 。 区 价 , 角角 刀刀刀一一 几 ,姐肚肚 忍忍一一 忍 朽朽 一 班 刀 叭 书书忍忍一一 几 田 ,王曰曰 乍 沪沪 以 田田一一 幻 肛 田 ,幻 叮叮一一 崛 麟 ,兀心 明明 用用 盯 泊泊一一川川 组 仪 阶一一 丘 份份份 岛 锹月月 口口 双 泌 钾 田田 , 肠肠肠一一 从 肠 叭 田田田峨 困困 砚 份份 一 旅 臼 岛 招招一一 瓜 宙 份份份田瓜 拍终 钾兀兀觅 田拍 一 拍介 代一 一 一 伽, 而 一一一 ,一一, 一 ,。 习。 一 ,一 伪 一伪一一一一 ,一 而 一而 ,一 一 , , , , 一【 田下 比, , , 一【 , , 一 妞 ,二。 , , 甲 , , 。 。 、 。 , “ , , , , , 、 , 行 甘 , 一 , , 幻 , 一 一 一, 一 ,毕业设计（论文）外文翻译题目对半刚性连接钢架的非线性有限元分析 专 业 名 称 机械设计制造及其自动化班 级 学 号 078105110学 生 姓 名 黎宝龙指 导 教 师 朱保利填 表 日 期 2011 年 03 月 08 日南昌航空大学科技学院学士学位论文11 绪论1.1选题的依据及意义平面连杆机构是许多构建用低副（转动副和移动副）连接组成的平面机构。机构的从动系统一般还可以进一步分解成若干个不可再分的自由度为零的构件组合，这种组合称为基本杆组，简称为杆组。机构的计算机仿真是指在研究中利用数学模型来获取系统的一些重要特性参数，这些数学模型通常是由以时间为变量的常微分方程来描述，并用数值方法进行计算机仿真求解。利用计算机仿真可以对整个机械制造系统及过程进行广泛地研究。一般而言，机构设计的目标之一是能够实现某一预先设定的运动轨迹。在研究机械系统的运动规律时，借助于计算机仿真是十分有益的。但是，大多数有关动力学方面的教科书较少涉及到计算机仿真，只是某些需要对研究对象进行运动方程精确描述的高等动力学教材才对计算机仿真有所体现。MATLAB 被称为三大数学软件之一。它在数学类科技应用软件中在数值计算方面首屈一指。MATLAB 可以进行矩阵运算、绘制函数和数据、实现算法、创建用户界面、连接其他编程语言的程序等，主要应用于工程计算、控制设计、信号处理与通讯、图像处理、信号检测、金融建模设计与分析等领域。MATLAB 的基本数据单位是矩阵，它的指令表达式与数学、工程中常用的形式十分相似，并且 mathwork 也吸收了像 Maple 等软件的优点,使 MATLAB 成为一个强大的数学软件，故用 MATLAB 来解算问题要比用 C，FORTRAN 等语言完成相同的事情简捷得多。所以采用 MALAB 来对平面连杆机构进行动态仿真。1.2国内外研究概况及发展趋势机构学是着重研究机械中机构的结构和运动等问题的学科，是机械原理的主要分支。研究各种机械中有关机构的结构、运动和受力等共性问题的一门学科。研究内容分两个方面：第一是对已有机构的研究，即机构分析（结构分析，运动分析和动力分析） ；第二是按要求设计新的机构，即机构综合（结构综合，运动综合和动力综合） 。传统的机构学把机构的运动(例如旋螺母的运动)看作只与其几何约束方式有关,而与受力、质量和时间等无关。这样，在 19 世纪中叶,机构学就从一般力学中独立出来，并日益发展。机构学的研究内容是对各种常用机构如连杆机构（见平面连杆机构和空间连杆机构） 、凸轮机构、齿轮机构(见齿轮传动)、差动机构、间歇运动机南昌航空大学科技学院学士学位论文2构、直线运动机构、螺旋机构(见螺旋传动)和方向机构等的结构和运动，以及这些机构的共性问题，在理论上和方法上进行机构分析和机构综合。 机构分析包括结构分析和运动分析两部分。前者研究机构的组成并判定其运动可能性和确定性；后者考察机构在运动中位移、速度和加速度的变化规律，从而确定其运动特性。掌握机构分析的方法对于如何合理使用机器、验证机械设计是否完善等是必不可少的，所以机构分析也是机构综合的基础。但是综合有时不存在唯一解，因而机构分析和综合往往是不可逆的。 设计新机器时,先要考虑两个问题：一是为了完成某一工艺或生产要求采取什么运动,这属于专业问题;二是采用什么机构来实现这种运动，这是机构综合问题。所谓机构综合就是根据要求实现的运动选定机构的结构类型,确定机构的几何尺寸,亦即进行机构的结构综合和运动综合,然后画出能够实现所求运动的机构运动简图。对于高速或高精度的机构，为更好地符合实际情况，还应考虑构件弹性和运动副间隙等实际因素的动力分析和动力综合。 MATLAB 名字由 MATrix 和 LABoratory 两词的前三个字母组合而成。那是 20 世纪七十年代后期的事：时任美国新墨西哥大学计算机科学系主任的 Cleve Moler 教授出于减轻学生编程负担的动机，为学生设计了一组调用 LINPACK 和 EISPACK 库程序的“通俗易用”的接口，此即用 FORTRAN 编写的萌芽状态的 MATLAB。MathWorks 公司于 1993 年推出 MATLAB4.0 版本，从此告别 DOS 版。4.x 版在继承和发展其原有的数值计算和图形可视能力的同时，出现了以下几个重要变化：（1）推出了 SIMULINK。这是一个交互式操作的动态系统建模、仿真、分析集成环境。它的出现使人们有可能考虑许多以前不得不做简化假设的非线性因素、随机因素，从而大大提高了人们对非线性、随机动态系统的认知能力。 （2）开发了与外部进行直接数据交换的组件，打通了 MATLAB 进行实时数据分析、处理和硬件开发的道路。 （3）推出了符号计算工具包。1993 年 MathWorks 公司从加拿大滑铁卢大学购得Maple 的使用权，以 Maple 为“引擎”开发了 Symbolic Math Toolbox 1.0。MathWorks 公司此举加快结束了国际上数值计算、符号计算孰优孰劣的长期争论，促成了两种计算的互补发展新时代。 （4）构作了 Notebook 。MathWorks 公司瞄准应用范围最广的 Word ，运用 DDE 和 OLE，实现了 MATLAB 与 Word 的无缝连接，从而为专业科技工作者创造了融科学计算、图形可视、文字处理于一体的高水准环境。南昌航空大学科技学院学士学位论文31997 年仲春，MATLAB5.0 版问世，紧接着是 5.1、5.2，以及和 1999 年春的 5.3版。与 4.x 相比，现今的 MATLAB 拥有更丰富的数据类型和结构、更友善的面向对象、更加快速精良的图形可视、更广博的数学和数据分析资源、更多的应用开发工具。 （关于 MATLAB5.x 的特点下节将作更详细的介绍。 ）诚然，到 1999 年底，Mathematica 也已经升到 4.0 版，它特别加强了以前欠缺的大规模数据处理能力。Mathcad 也赶在 2000 年到来之前推出了 Mathcad 2000 ，它购买了 Maple 内核和库的部分使用权，打通了与 MATLAB 的接口，从而把其数学计算能力提高到专业层次。但是，就影响而言，至今仍然没有一个别的计算软件可与MATLAB 匹敌。MATLAB 是当前数值计算方面应用地非常广泛的一种计算机软件。该软件具有一下几个特点：（1）该软件语言接近自然语言，极易入门有其他程序设计语言基础的人士学起来则更为容易；（2）该软件提供了大量的内部函数这使得其在使用中非常方便再则，日益庞大的 toolbox 使得该软件的应用领域越来越广泛；（3）该软件语言以向量、矩阵为着眼点，这使得它特别适宜于数值分析；（4）绘图功能强大。由于上述原因，MATLAB 在世界范围内很是流行，特别是在工程计算领域近年来越来越多的国人也喜爱上了这一套软件MATLAB 的 toolbox 中也含有概率统计方面的库函数概率方面的库函数主要有各种常见分布的分布函数、概率密度、分布率以及生成服从各种分布随机数的函数统计方面的库函数含盖了简单随机样本下常见的参数估计（点估计、区间估计） ，假设检验此外还含有大量涉及实验设计、线性回归、非线性回归等方面的库函数在欧美大学里，诸如应用代数、数理统计、自动控制、数字信号处理、模拟与数字通信、时间序列分析、动态系统仿真等课程的教科书都把 MATLAB 作为内容。这几乎成了九十年代教科书与旧版书籍的区别性标志。在那里，MATLAB 是攻读学位的大学生、硕士生、博士生必须掌握的基本工具。在国际学术界，MATLAB 已经被确认为准确、可靠的科学计算标准软件。在许多国际一流学术刊物上， （尤其是信息科学刊物） ，都可以看到 MATLAB 的应用。在设计研究单位和工业部门，MATLAB 被认作进行高效研究、开发的首选软件工南昌航空大学科技学院学士学位论文4具。如美国 National Instruments 公司信号测量、分析软件 LabVIEW，Cadence 公司信号和通信分析设计软件 SPW 等，或者直接建筑在 MATLAB 之上，或者以 MATLAB为主要支撑。又如 HP 公司的 VXI 硬件，TM 公司的 DSP，Gage 公司的各种硬卡、仪器等都接受 MATLAB 的支持。MATLAB 有着强大的功能和提供了丰富的资源，而将机械原理中的片面连杆机构有关运动学和动力学模型放到 Simulink 进行仿真方面的研究在国内还是比较少，而这方面的文献在国内更是不多。所以基于 MATLAB/Simulink 的平面连杆机构动态仿真将必将有力地促进机电产品的创新设计和开发，并在高科技发展进程中发挥重要作用。1.3 研究内容及实验方案研究内容：1、外文翻译；2、MATLAB 软件的使用；3、平面连杆机构的组成原理；4、RRRII 级杆组 MATLAB 运动学仿真模块；5、RRRII 级杆组 MATLAB 动力学仿真模块；6、RRR 四杆机构和 RRR-RRR 六杆机构的设计；7、RRR 四杆机构和 RRR-RRR 六杆机构的运动学仿真；8、RRR 四杆机构和 RRR-RRR 六杆机构的动力学仿真。设计方案：1、收集有关资料、写开题报告；2、翻译外文资料；3、熟悉 MATLAB 软件；4、学习 RRRII 级杆组 MATLAB 运动学和动力学仿真；5、设计一个 RRR 四杆机构和一个 RRR-RRR 六杆机构；6、RRR 四杆机构和 RRR-RRR 六杆机构的动态仿真；7、撰写毕业设计论文。南昌航空大学科技学院学士学位论文52 曲柄、RRR级杆组的 MTALAB 运动学仿真机构的运动分析，主要获得机构中某些构件的位移、角速度和角加速度，某些点的轨迹、速度和加速度。它是机械设计及评价机械运动和动力性能的基础，也是分析现有机械优化综合新机械的基本手段。一般的机构的运动分析，使用Quick Basic 语言或Fortran 语言/编写程序进行计算， 其缺点是“透明性”差， 修改麻烦等。本文用Matlab对机构进行运动学仿真，利用Matlab 的simulink 仿真模型的数据可视化的特点，就可以很容易观察到运动参数是如何变化的，极其简便。同时，用Matlab 建立和修改求解模型具有方便、快捷、很容易扩展等优点。Matlab 求解器提供很多求解不同微分方程的方法，可以根据不同的微分方程类型选择相应的求解方法。为了利用Matlab 强大的矩阵运算功能，本毕业设计课题对应用最为广泛的RRR级杆组推导了矩阵数学模型， 并编制了相应的Matlab 的M函数， 对相应的RRR级杆组进行了运动学仿真。2.1 用 MATLAB 实现牛顿-辛普森求解如图 2.1 所示，各构件 的尺寸为 =400mm, =1000m, =700mm, =1200mm,复数1r2r3r4r向量坐标如图所示。已知构件 1 的角位移 = 。60由图 2.1 铰链四杆机构复向量坐标，可以写出角位移方程为图 2.1 铰链四杆机构+ = + 1rje2j4r0je3j（2.1）南昌航空大学科技学院学士学位论文6将上式展开，整理得(2.2)由式（2.2）求出雅可比 矩阵为（2.3)根据式(2.2)、（2.3）编制的 M 函数如下：function y =rrrposi(x)while norm(f)epsilonJ=-x(5)*sin(theta2) x(6)*sin(theta3);x(5)*cos(theta2) -x(6)*cos(theta3);dth = inv(J)*(-1.0*f);theta2 = theta2+dth(1);theta3 = theta3+dth(2);f=x(4)*cos(x(1)+x(5)*cos(theta2)-x(7)-x(6)*cos(theta3);x(4)*sin(x(1)+x(5)*sin(theta2)-x(6)*sin(theta3);norm(f);end;y(1) = theta2;y(2) = theta3;rrrposi(x)函数为求构件 2 和构件 3 角位移的函数，输入参数为 x(1)=theta-1、x(2)=theta-2、x(3)=theta-3、x(4)=r1、x(5)=r2、x(6)=r3、x(7)=r4，输出参数为 theta2、theta3。铰链四杆机构在图 2.1 所示位置，估计构件 2 和构件 3 的角位移为 ，则输入参数 x=0 45*pi/180 110*pi/180 0.4 1 0.7 1.2带10,4532入上面的 M 函数，得构件 2 和构件 3 的角位移分别为 =44.07 ， =96.71 。232.2 用 MATLAB 进行速度分析对式（2.1）求导并整理成矩阵形式为（ 2.4） 0sinisin),( coco32132 41 rrf 32coscsiirrJ 113232 cosinsincosi rrr南昌航空大学科技学院学士学位论文7根据式（2.4）编写的 M 函数如下：function y = rrrvel(x)A = -x(6)*sin(x(2) x(7)*sin(x(3);x(6)*cos(x(2) -x(7)*cos(x(3);B = x(5)*sin(x(1);-x(5)*cos(x(1)*x(4);y = inv(A)*B;rrrvel(x)函数为求构件 2 和构件 3 角速度的函数，输入参数为 x(1)=theta-1、x(2)=theta-2、x(3)=theta-3、x(4)=dtheta-1、x(5)=r1、x(6)=r2、x(7)=r3，输出参数为 dtheta-2、dtheta-3。在图 2.1 铰链四杆机构中 =0 由位移分析计算1出的 和曲柄 1 的角速度 =10rad/s 及各个构件长度，则输入7.96,0.4321参数 x=0 44.07*pi/180 96.71*pi/180 10 0.4 1 0.7带上面的 M 函数得构件 2 和构件 3 的角速度分别为 =-4.9980rad/s， =-5.0004rad/s。232.3 曲柄、RRR级杆组 MATLAB 运动学仿真模块2.3.1 曲柄 MATLAB 运动学仿真模块图2.2 曲柄位置参数如图2.2所示，在复数坐标系中，曲柄AB复向量的模 为常数、幅角 为变量，jrj通过转动副A与机架连接，转动副A的复向量的模 为常量、幅角 为常量，曲柄ABi i端点B的位移、速度和加速度的推导如下：（2.5） 将方程（2.5）两边对时间t求两次导数得：（2.6）jijijjji errAB,)2/()2/( jj jj erer南昌航空大学科技学院学士学位论文8由式（2.6）写成矩阵形式有：（2.7 ） 根据式(2.7)编写曲柄原动件 MATLAB 的 M 函数如下：function y = crank(x)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;crank（x）函数为曲柄原动机的运动学仿真模块函数，其输入参数为 x(1)=rj、x(2)=thetaj、x(3)=dthetaj、x(4)=ddthetaj，输出函数为 y(1)=ReddB、y(2) = ImddB。2.3.2RRR级杆组 MATLAB 运动学仿真模块如图 2.3 所示，在复数坐标系中，由 3 个转动副（B,C,D）和 2 个构件（长度分别为 ）组成 RRR级杆组，2 个构件的幅角 和 为变量，则点 C 的加速度推到jir, ij如下图 2.3 RRR级杆组位置参数（2.8）jijerDrBC整理式（2.8）得（2.9）Bejij 对方程式（2.9）求导数并整理得 )sin()2/sin(cocoImRe2jjjj jjjj rrBDerrjijjii 2/2/南昌航空大学科技学院学士学位论文9（2.10） 对方程式（2.10）求导数并整理得（2.11）由（2.11）写成矩阵形式有（2.12 ）由式（2.12）写成矩阵形式有（2.13） 式（2.13）对时间 t 求导数，得点 C 的速度为（2.14） 式（2.14）对时间 t 求导数，得（2.15） 根据式（2.12）和式（2.15） 编写 RRR级杆组 MATLAB 的 M 函数如下：function y = RRRki(x)a = x(1)*cos(x(3)+pi/2) -x(2)*cos(x(4)+pi/2);x(1)*sin(x(3)+pi/2) -x(2)*sin(x(4)+pi/2);b=-x(1)*cos(x(3)+pi) x(2)*cos(x(4)+pi);-x(1)*sin(x(3)+pi) x(2)*sin(x(4)+pi)*x(5)2;x(6)2+x(9)-x(7);x(10)-x(8); BDererr jijjijijji ii 2/2/ BDrrrr jijjii jijjii ImRe)sin()sn(coco)2/si()2/s( 2jjiirBcosImReI iiirB)2/sn(cReI 2)sin(co)2/sin(coImeIR iirrBC 南昌航空大学科技学院学士学位论文10ddth = inv(a)*b;y(1) = ddth(1);y(2) = ddth(2);y(3) = x(7)+x(1)*ddth(1)*cos(x(3)+pi/2)+x(1)*x(5)2*cos(x(3)+pi);y(4) = x(8)+x(1)*ddth(1)*sin(x(3)+pi/2)+x(1)*x(5)2*sin(x(3)+pi);rrrki(x)函数为 RRR级杆组运动学的仿真模块函数，其输入参数为 x(1)=ri、x(2)=rj、x(3)=theta-i、x(4)=theta-j、x(5)=dtheta-i、x(6)=dtheta-j、x(7)=ReddB、x(8)=ImddB、x(9)=ReddD、x(10)=ImddD，输出参数为y(1)=ddtheta-i、y(2)=ddtheta-j、y(3)=ReddC、y(4)=ImddC。2.4 四杆机构的 MATLAB 运动学仿真铰链四杆机构如图 2.1 所示，它由原动件（曲柄 1）和 1 个 RRR 杆组构成。各构件的尺寸为 =400mm, =1000m, =700mm, =1200mm。建立如图 1 所示复数向量坐1r2r3r4r标，构件 1 以等角速度 10rad/s 逆时针方向回转，试求点 C 的加速度、构件 2,3 的角加速度。在 Simulink 环境下建立该铰链四杆机构的仿真模型如图 2.4 所示。在图 2.4 中各个 数据线上都表明了相应参数，其中 theta-2 表示构件 2 的角位移 ；dtheta-2 表示构件 2 的角速度 ；ddtheta-2 表示构件 2 的角加速度 ；22 ReddC和 ImddC分别表示点 C 加速度的水平分量和垂直分量，其他数据线上参数含义以此类推。各个积分模块的名称与该积分模块的输出参数名称一致，其值代表相应构件的长度或相应参数值。2 个函数模块 crank.m 和 rrrki.m 分别存放曲柄和RRR 杆组在 2.3 节中已经建立完的运动分析 M 函数。Simout 模块存放运动分析的结果。在图 2.4 中的各积分模块所设定的初值是以曲柄 1 的幅角为 ，角速度为010rad/s 时，相应各个构件的位移、速度值，这些通过 2.3 节中位移和速度分析得到。取长度单位为 m，角度单位为 rad。由于曲柄转速为 10rad/s,因此没转动 1 周的时间是 0.628s，设置仿真时间为 1s，仿真结果输出到工作空间变量 simout。南昌航空大学科技学院学士学位论文11南昌航空大学科技学院学士学位论文13图 2.4 曲柄滑块机构 Simulink 仿真模型南昌航空大学科技学院学士学位论文142.5 四杆机构 MATLAB 运动学仿真结果用绘图命令 plot（tout，simout（：，7），plot（tout，simout（：，8）,plot（tout，simout（：，5）和 plot（tout，simout（：，6）分别绘制出点 C 加速度的水平分量和垂直分量以及构件 2 的角加速度、构件 3 的角加速度，如图 2.5、图 2.6、图 2.7 和 2.8 所示。图 2.5 点 C 水平方向的加速度图 2.5 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(2smaCH在经过 0.628s 后，点 C 水平方向的加速度发生周期变化。南昌航空大学科技学院学士学位论文15图 2.6 点 C 垂直方向的加速度图 2.6 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(2smaCV在经过 0.628s 后，点 C 垂直方向的加速度发生周期变化。图 2.7 构件 2 的角加速度图 2.7 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(2srad在经过 0.628s 后，构件 2 的角加速度发生周期变化。南昌航空大学科技学院学士学位论文16图 2.8 构件 3 的角加速度图 2.8 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(23srad在经过 0.628s 后，构件 3 的角加速度发生周期变化。南昌航空大学科技学院学士学位论文173 曲柄、RRR级杆组的 MTALAB 动力学仿真机构的动力分析，主要是在运动学分析的基础上，由已知工作阻力，求出运动副的约束反力和驱动力（或力矩） ，为选择和设计轴承，零部件强度的计算及选择原动机提供理论依据。用MATLAB 对机构进行动力学求解，利用MATLAB 的Simulink求解模型的数据可视化的特点，就可以很容易观察到动力参数是如何变化的，极其简便。同时，用MATLAB建立和修改求解模型具有方便、快捷、很容易扩展等优点。MATLAB求解器提供很多解不同微分方程的方法，可以根据不同的微分方程类型选择相应的求解方法。为了利用MATLAB 强大的矩阵运算功能，本毕业设计课题对应用最为广泛的RRR级杆组推导了矩阵数学模型， 并编制了相应的MATLAB 的M函数， 对相应的RRR级杆组进行了动力学仿真。3.1 曲柄、RRR级杆组MATLAB 动力学仿真模块3.1.1 曲柄MATLAB动力学仿真模块图3.1 曲柄的受力模型如图4所示，已知曲柄AB向量的模 为常数，幅角 为变量，质心到转动副A的iri距离为 ,质量为 ，绕质心转动惯量为 ，作用于质心上的外力为 和 、外cirimiJxiFyi力矩为 ，曲柄与机架联接，转动副A的约束反力为 和 ，驱动力矩为 。iMxaRy1M由理论力学可得：（3.1）iixiBxAsmFRe（3.2）iiiyiygI南昌航空大学科技学院学士学位论文18（3.3） 由运动学知识可推得： （3.4）)cos()2/cos(Re2 iiiii rrAs（3.5）nnImiiiii将式（3.4） 、式（3.5）代入式（3.1） 、式（3.2） ，并与式（3.3）合并得:（3.6）根据式(2.6)编写曲柄原动件 MATLAB 的 M 函数如下：function y=crankdy(x)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*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;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。3.1.2 RRR级杆组 MATLAB 动力学仿真模块iiciiiciixB iiyAiixAi JrRBrMs)(sn)( o1 iiciyBicixBiciyAicixAi iyiiiiiei xBiiiciiciyAx MrRrRrrRJ gmFrrM os)(sn)(ossn)2/( )os(s21南昌航空大学科技学院学士学位论文19如图 3.2 所示， RRR级杆组，分别以 2 个构件 BC（长度为 ）和 CD（长度为 ）irjr为受力分析对象进行受力分析，其受力情况同曲柄 ，只是不受驱动力矩，则转动1M副 B,C,D 的约束反力推导如下：图3.2 RRR杆组受力模型对构件BC受力分析得（3.7）iixCixBsmRFe（3.8）iiiyiygI（3.9） iiyciiixciiiciicixBi JRrrrRrM os)(n)(ossn对构件CD受力分析得jjxCjxDsRFe（3.10） jijyiy mgI（3.11）南昌航空大学科技学院学士学位论文20（3.12） jjycjjjxcjjjcjyDjcjxDj JRrRrrRrM os)(sin)(ossin由运动学可推得)in()2/o(e2 ciiiciB（3.13）)os()/sin(Im iiccii rrs（3.14）)in()2/o(Re2 jjcjjcjD（3.15）)os()/sin(I2 jjcjjcj rrs（3.16）将式（3.13）-（3.16）分别代入式（3.7）、式（3.8）、式（3.10）、式（3.11）并与式（3.9）、式（3.12）写成矩阵为（3.17）根据式（3.17）编写RRR级杆组MATLAB的M函数如下：function y = RRRdy(x)g=9.8;ri = 1;rj = 0.7;rci = 0.5;rcj = 0.35; jj jxjjjcjjjcjj jjjjjjjj ii ixiiiciici iiiiiii yDxyCxyBxjcjjcjjcjjjcjj iciiiciiiciici JgmFrmrmDMJgrrB Fmm RRrrrrrrrr )sin()2/sin(I ooRe )sn()2/sn(I ooe ossn)(s)(0 101001os)(sn)(ossn10 022南昌航空大学科技学院学士学位论文21mi = 3;mj = 2.2;Ji = 0.25;Jj = 0.09;ReddD = 0;ImddD = 0;Fxi = 0;Fyi = 0;Mi = 0;a = zeros(6);a(1,1) = 1;a(1,3) = 1;a(2,2) = 1;a(2,4) = 1;a(3,1) = rci*sin(x(1);a(3,2) = -rci*cos(x(1);a(3,3) = -(ri-rci)*sin(x(1);a(3,4) = (ri-rci)*cos(x(1);a(4,3) = -1;a(4,5) = 1;a(5,4) = -1;a(5,6) = 1;a(6,3) = (rj-rcj)*sin(x(2);a(6,4) = -(rj-rcj)*cos(x(2);a(6,5) = rcj*sin(x(2);a(6,6) = -rcj*cos(x(2);b =zeros(6,1);b(1,1) = mi*rci*x(5)*cos(x(1)+pi/2)+mi*x(7)+mi*rci*x(3)2*cos(x(1)+pi)-Fxi;b(2,1) = mi*rci*x(5)*sin(x(1)+pi/2)+mi*x(8)+mi*rci*x(3)2*sin(x(1)+pi)-Fyi+mi*g;b(3,1) = Ji*x(5)-Mi;b(4,1) = mj*rcj*x(6)*cos(x(2)+pi/2)+mj*ReddD+mj*rcj*x(4)2*cos(x(2)+pi)-x(9);b(5,1) = mj*rcj*x(6)*sin(x(2)+pi/2)+mj*ImddD+mj*rcj*x(4)2*sin(x(2)+pi)-x(10)+mj*g;b(6,1) = Jj*x(6)-x(11);y = inv(a)*b;rrrdy(x)函数为RRR级杆组的动力学仿真模块，其输入参数x(1)=theta-i、x(2)=theta-j、x(3)=dtheta-i、x(4)=dtheta-j、x(5)=ddtheta-i、x(6)=ddtheta-j、x(7)=ReddB、x(8)=ImddB、x(9)=Fxj、x(10)=Fyj、x(11)=Mj；其输出参数为y(1)=RxB、y(2)=RyB、y(3)=RxC、y(4) = RyC、y(5)=RxD、y(6)=RyD；其中的已知参数为g=9.8;ri = 1;rj = 0.7;rci = 0.5;rcj = 0.35;mi = 3;mj = 2.2;Ji = 0.25;Jj = 0.09;ReddD = 0;ImddD = 0;Fxi = 0;Fyi = 0;Mi = 0。南昌航空大学科技学院学士学位论文223.2四杆机构的MATLAB动力学仿真铰链四杆机构如图 2.1 所示，它由原动件（曲柄 1）和 1 个 RRR 杆组构成。各构件 的尺寸为 =400mm, =1000m, =700mm, =1200mm；质心为1r2r3r4r=200mm， =500mm， =350mm；质量为 =1.2kg， =3kg， =2.2kg；转动惯1cr2cr3cr1m23m量为 ， ， ，构件 3 的工作阻力矩06.mkgJ225.0kgJ309.kgJ，顺时针方向，其他构件所受外力和外力矩均为零，构件 1 以等角速NM3度 10rad/s 逆时针方向回转，试求在不计摩擦时，转动副 A 的约束反力、驱动力矩以及所作的功。在 Simulink 环境下建立该铰链四杆机构的仿真模型如图 3.3 所1示。南昌航空大学科技学院学士学位论文23图 3.3 铰链四杆机构 Simulink 仿真模型南昌航空大学科技学院学士学位论文243.3 四杆机构 MATLAB 仿真模型的初值确定铰链四杆机构 Simulink 仿真模型中 theta-2、theta-3 的初值由 2.1 节内容求得，而 dtheta-2 和 dtheta-3 的初值由 2.2 节内容求得。3.4 四杆机构 MATLAB 动力学仿真结果用绘图命令 plot（tout，simout1（：，1），plot（tout，simout1（：，2）,plot（tout，simout1（：，3）和plot（tout，simout1（：，4）分别绘制出转动副 A 的约束反力、驱动力矩及其所作的功，如图 3.4、图 3.5、图 3.6 和图 3.7 所示。图 3.4 转动副 A 的水平方向力图 3.4 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出在经过NRAH/0.628s 后，转动副 A 的水平方向力发生周期变化。南昌航空大学科技学院学士学位论文25图 3.5 转动副 A 的垂直方向力图 3.5 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出在经过NRAV/0.628s 后，转动副 A 的垂直方向力发生周期变化。图 3.6 曲柄上作用的力矩图 3.6 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出在)/(1mNM经过 0.628s 后，曲柄上作用的力矩发生周期变化。南昌航空大学科技学院学士学位论文26图 3.7 曲柄力矩所作的功图 3.6 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出在经过JW/10.628s 后，曲柄力矩所作的功发生周期变化。南昌航空大学科技学院学士学位论文274 RRR-RRR 六杆机构的 MTALAB 运动学仿真4.1 RRR-RRR 六杆机构图 4.1 是由原动件（曲柄 1）和 2 个 RRR 杆组组成的 RRR-RRR 六杆机构。各构件的尺寸为 , , , , ,mr5.261r6.02mr5.73r5.874mr6,复数向量坐标如图所示，构件 1 以等角速度 10rad/s 逆时针方向回转，mr486试求点 C 和点 E 的加速度以及构件 5,6 的角速度和角加速度。图 4.1 RRR-RRR 六杆机构运动简图的复数坐标4.2 RRR-RRR 六杆机构 MATLAB 仿真模型该 RRR-RRR 六杆机构的 MATLAB 仿真模型如图 4.2 所示。在图 4.2 中各积分模块的初值是以曲柄 1 的幅角为 何角速度等于 10rad/s 逆时针方向回转时，相应各个60构件的位置、速度的瞬时值，3 个 MATLAB 函数模块分别为 crank_5.m，rrrki_4.m和 rrrki_5.m,其中 crank_5.m 函数模块的输入参数为曲柄的角位移、曲柄的角速度和曲柄的角加速度、输出参数曲柄端部（转动副 B）的加速度的水平分量和垂直分量，曲柄的长度在函数内部设置。Rrrki_4.m 函数模块的输入参数为构件 2 和构件3 的角位移、角速度和转动副 B 的加速度，构件 2 和构件 3 的长度在该函数模块内设置。Rrrki_5.m 函数模块的输入参数为构件 5 和构件 6 的角位移、角速度和转动副 C 的加速度，构件 5 和构件 6 的长度在该函数模块内设置。每个数据线上标注了南昌航空大学科技学院学士学位论文28相应变量，常量模块放置了各个构件的尺寸，长度单位为 M，角度单位为 rad。设置仿真时间为 1s，仿真结果输出到工作空间变量 simout*中，求解器选用 ode45，步长选用变步长。南昌航空大学科技学院学士学位论文29图 4.2 RRR-RRR 六杆机构 Simulink 仿真模型南昌航空大学科技学院学士学位论文304.3 RRR-RRR 六杆机构 MATLAB 仿真模块RRR-RRR 六杆机构 Simulink 仿真模型中的 crank_5.m 函数模块的 M 函数为：function y = crank_5(x)rj = 0.0265ddB = rj*x(3)*cos(x(1)+pi/2)+rj*x(2)2*cos(x(1)+pi);rj*x(3)*sin(x(1)+pi/2)+rj*x(2)2*sin(x(1)+pi);y = ddB;crank_5 函数为曲柄原动机的运动学仿真模块函数，其输入参数为 x(1)=thetaj、x(2)=dthetaj、x(3)=ddthetaj，输出函数为 y(1)=ReddB、y(2) = ImddB，其中已知 rj=0.0265。rrrki_4.m 函数模块的 M 函数为：function y = RRRki_4(x) ri = 0.1056;rj = 0.0675;a = ri*cos(x(1)+pi/2) -rj*cos(x(2)+pi/2);ri*sin(x(1)+pi/2) -rj*sin(x(2)+pi/2);b = -ri*cos(x(1)+pi) rj*cos(x(2)+pi);-ri*sin(x(1)+pi) rj*sin(x(2)+pi)*x(3)2;x(4)2+-x(5);-x(6);ddth = inv(a)*b;y(1) = ddth(1);y(2) = ddth(2);y(3) = x(5)+ri*ddth(1)*cos(x(1)+pi/2)+ri*x(3)2*cos(x(1)+pi);y(4) = x(6)+ri*ddth(1)*sin(x(1)+pi/2)+ri*x(3)2*sin(x(1)+pi);rrrki_4(x)函数为 RRR级杆组运动学的仿真模块函数，其输入参数为 x(1)=theta-i、x(2)=theta-j、x(3)=dtheta-i、x(4)=dtheta-j、x(5)=ReddC、x(6)=ImddC，输出参数为 y(1)=ddtheta-i、y(2)=ddtheta-j、y(3)=ReddC、y(4)=ImddC,其中已知 ri=0.1056、rj=0.0675。rrrki_5.m 函数模块的 M 函数为：function y = RRRki_5(x)南昌航空大学科技学院学士学位论文31ri = 0.065rj = 0.048a = ri*cos(x(1)+pi/2) -rj*cos(x(2)+pi/2);ri*sin(x(1)+pi/2) -rj*sin(x(2)+pi/2);b = -ri*cos(x(1)+pi) rj*cos(x(2)+pi);-ri*sin(x(1)+pi) rj*sin(x(2)+pi)*x(3)2;x(4)2+-x(5);-x(6);ddth = inv(a)*b;y(1) = ddth(1);y(2) = ddth(2);y(3) = x(5)+ri*ddth(1)*cos(x(1)+pi/2)+ri*x(3)2*cos(x(1)+pi);y(4) = x(6)+ri*ddth(1)*sin(x(1)+pi/2)+ri*x(3)2*sin(x(1)+pi);rrrki_5(x)函数为 RRR级杆组运动学的仿真模块函数，其输入参数为 x(1)=theta-i、x(2)=theta-j、x(3)=dtheta-i、x(4)=dtheta-j、x(5)=ReddC、x(6)=ImddC，输出参数为 y(1)=ddtheta-i、y(2)=ddtheta-j、y(3)=ReddE、y(4)=ImddE,其中已知 ri=0.065、rj=0.048。4.4 RRR-RRR 六杆机构 MATLAB 仿真模块中初值的确定仿真模型中 的初值已经给出，而 的初值确定则需用牛顿-辛普1,6532,森方法求解：由图 4.1RRR-RRR 六杆机构运动简图的复数坐标，可以写出角位移方程为（4.1）将上式展开，整理得（4.2 ）由式（4.2）求出雅可比矩阵为（4.3 ）6533210404 jjjj jerAFerer 0sinsini),( cocoiii, ssco)( 6253654 143 3212 41 rarff 65323coscsos0iniin0csii rrrrrJ南昌航空大学科技学院学士学位论文32根据式(4.2)、（4.3）编制的 M 函数如下：function y =rrrposi_3(x)while norm(f)epsilonJ=-x(7)*sin(theta2) x(8)*sin(theta3) 0 0;x(7)*cos(theta2) -x(8)*cos(theta3) 0 0;0 -x(8)*sin(theta3) -x(10)*sin(theta5) x(11)*sin(theta6);0 x(8)*cos(theta3) x(10)*cos(theta5) -x(11)*cos(theta6);dth = inv(J)*(-1.0*f);theta2 = theta2+dth(1);theta3 = theta3+dth(2);theta5 = theta5+dth(3);theta6 = theta6+dth(4);f = x(6)*cos(x(1)+x(7)*cos(theta2)-x(9)-x(8)*cos(theta3);x(6)*sin(x(1)+x(7)*sin(theta2)-x(8)*sin(theta3);x(9)+x(8)*cos(theta3)+x(10)*cos(theta5)-x(12)-x(11)*cos(theta6);x(8)*sin(theta3)+x(10)*sin(theta5)-x(13)-x(11)*sin(theta6);norm(f);end;y(1) = theta2;y(2) = theta3;y(3) = theta5;y(4) = theta6;rrrposi_3(x)函数为求构件 2、构件 3、构件 4、构件 5 角位移的函数，函数的输入参数为 x(1)=theta - 1、x(2)=theta - 2、% x(3)=theta - 3、x(4) = theta - 5 、x(5)=theta - 6、% x(6)=r1、x(7)=r2、x(8)=r3、x(9)=r4、x(10)=r5、x(11)=r6、x(12)=a1、x(13)=a2，函数的输出参数为 y(1)=theta - 2、y(2)=theta - 3、y(3)=theta - 5、y(4)=theta - 6，当输入参数 x = 60*pi/180 20*pi/180 70*pi/180 320*pi/180 280*pi/180 0.0265 0.1056 0.0675 0.0875 0.065 0.048 0.15 0.07带入上面的 M 函数时，得构件 2、构件 3、构件 5 和构件 6 的角位移分别为南昌航空大学科技学院学士学位论文33。 285,3,70,2365对式（4.1）求导并整理成矩阵形式为（4.4）根据式（4.4）编写的 M 函数如下：function y = rrrvel_2(x)A = -x(8)*sin(x(2) x(9)*sin(x(3) 0 0;x(8)*cos(x(2) -x(9)*cos(x(3) 0 0;0 -x(9)*sin(x(3) -x(10)*sin(x(4) x(11)*sin(x(5);0 x(9)*cos(x(3) x(10)*cos(x(4) -x(11)*cos(x(5);B = x(7)*sin(x(1);-x(7)*cos(x(1);0;0*x(6);y = inv(A)*B;rrrvel_2(x)函数为求构件 2、构件 3、构件 5 和构件 6 角速度的函数，输入参数为 x(1)=theta-1、x(2)=theta-2、x(3)=theta-3、x(4)=theta-5、x(5)=theta-6、x(6)=dtheta - 1、x(7)=r1、x(8)=r2、x(9)=r3、x(10)=r5、x(11)=r6，输出参数为 y(1)=dtheta-2、y(2)=dtheta-3、y(3)=dtheta-5、y(4)=dtheta-6。在图4.1RRR-RRR 六杆机构中 =60 由位移分析计算出的1和曲柄 1 的角速度 =10rad/s 及各个构件长度， 285,3,70,2365 1则输入参数 x = 60*pi/180 23*pi/180 70*pi/180 322*pi/180 285*pi/180 10 0.0265 0.1056 0.0675 0.065 0.048带入上面的 M 函数得构件 2 和构件 3 的角速度分别为 =-4.9980rad/s， =-5.0004rad/s， =3.1974, =-3.1974, =-2 35567.1793。4.5 RRR-RRR 六杆机构 MATLAB 运动学仿真结果由于曲柄转速为 10rad/s，因此没转动 1 周德时间是 0.628s，用绘图命令plot(tout,simout1),plot(tout,simout2),plot(tout,simout(:,3),plot(tout,si 11653236532 0cosincoscsos0iniin0csii rrrrrr南昌航空大学科技学院学士学位论文34mout(:,4),plot(tout,simout(:,5),plot(tout,simout(:,6)分别绘制出点 C 和点 E 的加速度以及构件 5,6 的角速度和角加速度，如图 4.3、图 4.4、图 4.5、图4.6、图 4.7、图 4.8 所示。图 4.3 点 C 的加速度图 4.3 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出在)/(2smaC经过 0.628s 后，点 C 的加速度发生周期变化。图 4.4 点 E 的加速度图 4.4 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出在)/(2saE南昌航空大学科技学院学士学位论文35经过 0.628s 后，点 C 的加速度发生周期变化。图 4.5 构件 5 的角速度图 4.5 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(15sradw在经过 0.628s 后，构件 5 的角速度发生周期变化。图 4.6 构件 6 的角速度图 4.6 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(16srad南昌航空大学科技学院学士学位论文36在经过 0.628s 后，构件 6 的角速度发生周期变化。图 4.7 构件 5 的角加速度图 4.7 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(25srad在经过 0.628s 后，构件 5 的角加速度发生周期变化。图 4.8 构件 6 的角加速度南昌航空大学科技学院学士学位论文37图 4.8 中，纵坐标为 ，横坐标为 t/s,从图中曲线的变化可以看出)/(26srad在经过 0.628s 后，构件 5 的角加速度发生周期变化。5 RRR-RRR 六杆机构的 MTALAB 动力学仿真5.1 RRR-RRR 六杆机构图 4.1 是由原动件（曲柄 1）和 2 个 RRR 杆组组成的 RRR-RRR 六杆机构。各构