六自由度系统集成设计(一)课件.ppt

《六自由度系统集成设计(一)课件.ppt》由会员分享，可在线阅读，更多相关《六自由度系统集成设计(一)课件.ppt（103页珍藏版）》请在三一办公上搜索。

1、六自由度运动系统集成设计,姜洪洲（）机电学院流体控制及自动化系,课程主要内容,并联机构的概念、特点、发展史、应用并联机构的基础知识耦合分析与各向同性设计单叶双曲面上的并联机构,1 Stewart运动平台的概念,Any system connected to the environment through six parallel joints with five(passive)rotational and one(active)translation d.o.f is considered a Stewart platform,Generalized Stewart Platform（广义）

2、,Kutzbach Grubler公式，是一般形式的空间机构自由度计算公式,1 Stewart运动平台的概念,上铰点与下铰点分别组成了两个等边三角形两三角形布置相差180度六个执行机构参数完全一样,Specific Stewart Platform（标准或狭义）,1 Stewart运动平台的概念,执行器正交布置的振动台,Generalized Stewart Platform,确定输入,超确定输入（具有冗余支腿）,1 Stewart运动平台的概念,Stewart 平台的变体三自由度摇摆台机构布置：液压伺服作动器和拉杆的布置如图所示，其中1、2为垂直作动器，3为水平作动器4、5、6为拉杆。本质上

3、，它是6-TPS型六自由度并联机构的变体，即把其中三个支腿的滑动副约束掉，成为三自由度并联机构。自由度：图中所示机构具有三个自由度。可以从运动平台的平移和转动六个运动参数中任选三个，作为此机构的广义坐标。此机构的作用主要是实现摆动，所以选取欧拉角作为广义坐标。由作动器1、2、3产生的转动的同时，不可避免地产生平动牵连运动。,Generalized Stewart Platform,1 Stewart运动平台的概念,下铰并非在同一个平面内这是系统集成优化设计的结果,Generalized Stewart Platform,2 Stewart运动平台的主要特点,并联机构的运动平台同时经由6根杆支撑

4、，与串联的悬臂梁相比，刚度大，而且结构稳定；由于刚度大，并联机构较串联机构在相同的自重或体积下，有高得多的承载能力；串联机构的误差是各个关节误差的积累和放大，因而误差大、精度低，并联机构的误差趋于平均化，因此误差小、精度高；串联机构的驱动系统及传动系统大都放在运动着的大小臂上，增加了系统的惯量，恶化了动力性能，而并联机构则很容易将电机置于机座上，减小了运动负荷，动力性能好；位置求解上，串联机构正解容易，但反解十分困难，而并联机构正解困难，反解却非常容易。串联并联的“对偶”关系,2 Stewart运动平台的主要特点,3国内外主要研究团体,J.P.Merlet（法国国家科学院）黄真（燕山大学）,h

5、ttp:/www-sop.inria.fr/coprin/equipe/merlet/merlet_eng.html,黄真，孔令富，方跃法著.并联机器人机构学理论及控制.北京：机械工业出版社，1997，12,参考教材,黄真，并联机器人机构学理论及控制,机械工业出版社.1997,个人简况：1959年毕业于哈尔滨工业大学机械工艺专业，现任燕山大学机械工程学院教授，博士生导师。我国最早的一位从事并联机器人研究的学者。,参考教材,液压6-DOF并联机器人操作手运动和力控制的研究.河北大学出版社.2001,河北大学校长 王洪瑞教授,J-P.Merlet,参考教材,http:/www-sop.inria.

6、fr/members/Jean-Pierre.Merlet/merlet_eng.html,法国国家信息与自动化研究所（INRIA）,参考教材,G.Gogu.Structural Synthesis of Parallel Robots,Springer,2006,罗马尼亚人现为法国某大学教授,博士学位：机床动力学；博士学位：机器人；,参考教材,McGill University,加拿大魁北克省蒙特利尔,IFToMM,the InternationalFederation for the Promotion of Mechanism and Machine Science,黄真,知名学者,方跃

7、法：北交大研究生院副院长,高 峰：河北工大校长、上海交大,孔令富：燕山大学副校长,李秦川：浙江理工教授,王洪瑞：河北大学校长,学生：,赵永生：燕山大学 机械工程学院院长,赵铁石：燕山大学科学技术研究院副院长,J.P.Merlet,知名学者,http:/www-sop.inria.fr/members/Jean-Pierre.Merlet/merlet_eng.html,Jorge Angeles,知名学者,McGill University,加拿大魁北克省蒙特利尔,印度Bhaskar Dasgupta,知名学者,T.S.Mruthyunjaya,著名的综述性文章：The Stewart pla

8、tform manipulator:a review2000,印度理工、坎普尔,印度理工、班加罗尔,Stewart平台,Stewart D.A platform with 6 degrees of freedom.Proc.of the Institution of mechanical engineers,180(Part 1,15):371386,1965.,引用次数：1200次,4并联机构提出与历史,Stewart平台,4并联机构提出与历史,Gough,Gough tire-testing machine,1947年，英国Eric Gough博士,4并联机构提出与历史,Cappel,K.

9、L.,1960s by Cappel for helicopter simulator,4并联机构提出与历史,专利,US3295224,http:/,1967年,4并联机构提出与历史,4 并联机构提出与历史,Cappel,K.L.,1960s by Cappel for helicopter simulator,4 并联机构提出与历史,振动台,4并联机构提出与历史,K.H.Hunt,(1920-2002),澳大利亚莫那什大学机构学教授,提出将并联机构用于机器人领域,1990,Oxford University Press(Oxford,New York),4 并联机构提出与历史,K.H.Hun

10、t,发表串并对偶性文章,Series-parallel Dualities in Actively Coordinated Mechanisms,Kenneth J.Waldron Kenneth H.HuntOhio State University Monash UniversityColumbus,Ohio,U.S.A.Clayton,Victoria,Australia,It will be demonstrated that there is a deep symmetry between serial chain manipulators and fully parallel sy

11、stems such as the Stewart platform.,4 并联机构提出与历史,5并联机构方面的顶级国际期刊,IEEE Transactions on Robotics(TRO):founded in 1985,published by the IEEE.International Journal of Robotics Research(IJRR):founded in 1982,published by SAGE Publications.Journal of Mechanical Design(JMD):founded in 1978,published by the A

12、SME.Mechanism and Machine Theory(MMT):founded in 1966,official journal of IFToMM,published by Elsevier.Robotics and Computer-Integrated Manufacturing(RCIM):founded in 1988,published by Elsevier.Advanced Robotics(AR):founded in 1986,official journal of the Robotics Society of Japan,published by Brill

13、.Journal of Intelligent and Robotics Systems(JIRS):founded in 1988,published by Springer.Robotica(Ro):founded in 1983,official journal of the International Federation of Robotics and CLAWAR,published by Cambridge University Press.,Articles on parallel robots in the eight journals studied,6 Stewart运动

14、平台的主要应用,运动模拟（飞行模拟、驾驶模拟、道路模拟、海浪模拟、空间对接地面试验）并联机床并联机器人精密定位装置（微动机构、大规模集成电路加工、并联挖掘机械、空间装配机械手、大型望远镜、照相机聚焦等）六维力/力矩传感器隔振平台（利用它的快速响应能力）,6.1运动模拟空间对接,日本航天局空间对接机构地面半物理仿真设备,6.1运动模拟空间对接,俄罗斯空间对接机构地面半物理仿真综合试验台,6.1运动模拟空间对接,大回路系统攻关试验项目为超前开展的综合试验台关键技术攻关项目之一。该项目验证了大回路工作原理的正确性、验证了控制系统一体化开发方案的可行性、并积累了丰富的调试经验。解决了动力学基频与运动模

15、拟器频宽关系问题、大回路力控制阶段系统稳定性问题，为下一步进行对接机构综合试验台的设计提供了理论与实验上的依据。下一步继续进行平台标定、碰撞检测等项研究,对接机构综合试验台大回路攻关试验哈尔滨工业大学电液伺服仿真及试验系统研究研制,6.1运动模拟飞行模拟,加拿大CAE公司建造的飞行模拟器,6.1运动模拟飞行模拟,荷兰DELFT大学International Research Institute of Simulation,Motion and Navigation(SIMONA)国际研究院研制的世界上最先进的飞行模拟器（2002）,6.1运动模拟道路模拟,The US Armys Tank-a

16、utomotive and Armaments Command(TACOM)建造的用于坦克武器装备试验的运动模拟设备,6.1运动模拟汽车驾驶模拟,建在美国依阿华大学的目前世界上最先进的汽车驾驶模拟器（MTS制造）,1994年，美国 Giddings&Lewis 公司展出第一台并联运动机床：Variax 加工中心，该机床现在英国Nottingham 大学工学院1996年，美国 Ingersoll 公司推出VOH1000型立式加工中心和HOH600型卧式加工中心，现分别在美国国家标准与技术研究所和德国阿亨工业大学机床实验室,6.2并联机床,Variax 加工中心,6.2并联机床,6.2并联机床,并

17、联机床，又称虚拟轴机床或并联运动机构(PKM)。并联机床实质上是机器人技术与机床结构技术结合的产物。图中为Ingersoll公司生产的VOH-1000五轴成型中心，其机构形式采用标准Gough-Stewart平台结构，加工精度达到20m，最大速度为0.5m/s。,同济大学 张曙教授,6.2并联机床,毕业于哈尔滨工业大学。现任同济大学教授、博士生导师,我国先进制造技术研究和应用的倡导者和先驱者之一,并联机床,6.2并联机床,张曙，江苏如皋人，1932年3月生。1956年毕业于哈尔滨工业大学机床与工具专业，获机械工程师资格。现任同济大学教授、博士生导师 张曙多年从事机床设计、制造业发展战略和信息化

18、的研究。先后提出“独立制造岛”和“分散网络化制造”的理论，并在生产中得到应用。曾获得“全国优秀科技工作者”、“上海市科技功臣”等光荣称号和国内外多项重大奖励。,并联机床,BXK并联机床哈工大与哈量集团,6.2并联机床,王知行教授,并联机床,DCB510混联机床大连机床厂和清华大学,Linapod混联机床天津大学和天津第一机床厂,BXK并联机床哈工大与哈量集团,6.2并联机床,6.3并联机器人精密定位装置,PI公司的M-850微定位系统位移行程X、Y向为50mm，Z向达25mm，三个角位移行程X、Y向为15，Z向达30。位移重复精度X、Y向为2m，Z向达1m，三个角位移重复精度10微弧度。,PI

19、公司微动机构,Preliminary Data:M-810 D=100mm H=118mm max Load=5kg max Vel=10mm/s Travel X,Y+/-20mm Travel Z+/-6.5mm Travel U,V+/-11deg Travel W+/-30deg,6.3并联机器人精密定位装置,负载5kg,负载1000kg,PI公司微动机构,6.3并联机器人精密定位装置,6.4六维力传感器,德国洪堡大学,6.5并联机器人,医用机器人,太空机器人,6.5并联机器人,二进制驱动,6.5并联机器人,Designing a Stewart Platform-based Coop

20、erative System for LargeComponent Assembly,IEEE International Conference on Methods and Models in Automation and Robotics,2001,6.5并联机器人,6.5并联机器人,西电校长段宝岩,FAST总体方案,6.6天文望远镜,FAST总体方案,6.5天文望远镜,FAST项目选址贵州南部喀斯特洼地,6.5天文望远镜,稳定平台（无人机平台稳定）,6.6稳定与隔振,振动隔离与精确指向,6.6稳定与隔振,振动隔离与精确指向,6.6稳定与隔振,振动隔离与精确指向,University of

21、 Wyoming,John E.McInroy,弹道导弹防御,6.6稳定与隔振,7六自由度并联机构的研究方向,机构学的研究（拓扑结构与几何关系）运动学（反解与正解）动力学（拉格朗日、牛顿-欧拉、凯恩）工作空间分析（定姿态，定位置）误差分析/标定奇异性研究（构型奇异、位型奇异、算法奇异）控制包括控制器设计（自由度控制、单系统控制、基于模型的控制）轨迹规划作动器、关节应用研究（不同的应用对并联机构有不同的需求）,8预备知识坐标系定义,连体坐标系M和惯性坐标系G,8预备知识姿态描述,六自由度运动平台的姿态，一般采用欧拉角表示。即运动平台在空间的转动姿态往往由一个绕轴x,y和z的旋转序列来规定。这种转

22、角的序列，称为欧拉(Euler)角。欧拉角用绕z轴旋转角psi，再绕新的轴(y)旋转角theta，最后绕新的轴(x”)旋转角phi来描述任何可能的姿态。,8预备知识,姿态旋转矩阵R,8预备知识,8预备知识,台体角速度 与欧拉角变化率 之间的关系,8预备知识位置反解,给定平台的位置求液压缸的伸长量,8预备知识,8预备知识,液压缸伸长量变化率（伸长速度）,8预备知识雅可比阵,8预备知识雅可比阵,运动平台的控制输入，液压缸出力，对平台运动产生的影响从速度和力两方面来解释运动可控条件与力的奇异条件位型奇异,雅可比阵的物理意义,8预备知识位置正解,解析算法Interval AnalysisNewton-

23、Raphson 数值解法,已知液压缸（线性执行机构）的伸长量求运动平台的位置（位姿）,8预备知识NR算法的收敛条件,雅可比阵的差分变化不大（Lipschitz条件）雅可比阵远离奇异所取的初值不能太接近边界,位置正解的Simulink模型,8预备知识刚度,杆的结构与材料;关节的刚度;动平台与基平台的刚度;并联机器人的几何结构；并联机器人的拓扑结构;动平台的位置与姿态,刚度与下列因素有关:,8预备知识刚度,最小刚度的发生是沿对应的刚度阵的最小的特征值对应的特征向量方向;相应地，最大刚度的发生是沿对应的刚度阵的最大的特征值对应的特征向量方向。,8预备知识刚度,典型的HUNT奇异位型：当所有支腿轴线交

24、于空间一直线L从力平衡的角度，所有支腿的主动力无法平衡重力，以及绕该直线的负载力矩从刚度的角度，垂向以及绕某水平轴线方向刚度最小，趋近于0,8预备知识刚度,8预备知识刚度,2、5号液压缸所受拉力达到18KN，1、6号液压缸所受到的压力达到20.5KN，而上平台和负载总重为620kg，相当于6.2KN。,8预备知识液压缸伸长加速度,8预备知识液压缸伸长加速度,8预备知识液压缸伸长加速度,8预备知识动力学建模,动力学建模的主要目的是研究运动平台所受驱动力与平台的运动参量(位移，速度，加速度)之间的关系，得出描述有关平台驱动力，负载及加速度的动力学方程，以表达运动系统的动力学特性，它是液压驱动系统和

25、控制系统设计的基础。,8预备知识动力学建模,牛顿欧拉方程,8预备知识动力学建模,单系统解耦系统模态,9Stewart运动平台的运动学与动力学指标,一般采用各自由度最大位移，最大速度，最大加速度参数来表示运动平台的能力。一般采用最大功能曲线来描述。最大功能曲线，就是把运动平台的最大运动参数与运动频率之间的关系采用图示的方式表达出来。,9运动平台的性能参数估计方法,利用雅可比阵可以进行最大速度估计最大出力估计最大位移估计,已知执行机构的最大速度已知执行机构的最大出力,9工作空间计算方法,采用二分法对自由度最大边界进行精确估计,9,Simona Stpl机构参数,7,中位时的特性,9运动包络测试,6

26、4组极限状态下的位姿,9最大功能曲线,10设计参数优化,Stewart平台是六根可伸缩的杆分别通过关节将上下平台相联形成的机构，通过杆长的变化实现活动平台的位置和姿态的改变，因此一般情况下确定一个Stewart平台结构的参数就为:上、下平台各关节铰链连接点的位置安排分布，杆长的上下限。,9设计参数优化,设计参数上、下平台各铰链连接点所在分布圆的半径上、下平台各铰链连接点短边的长度或对应的角度杆长的上、下限,9设计参数优化,优化目标工作空间、灵巧度、刚度、给定负载下的最小驱动力、给定杆长误差下动平台的最小定位误差、给定驱动速度与加速度上平台达到最大速度与加速度等。在设计当中可以根据自己平台功能选

27、定相应的评定指标，再乘以权值，求取一组优化参数。,9设计参数优化,约束条件无奇异(运动包络)不干涉杆长、铰链转角限制其他约束（功率、成本）,9设计参数优化,刚度上铰圆半径越小，横向刚度越大，转动刚度降低上平台高度越低，横向刚度越大，转动刚度降低,9设计参数优化,工作空间其余设计变量不变，最小杆长越短，工作空间越大;其余设计变量不变，上平台半径越小，工作空间越大;其余设计变量不变，关节运动范围越大，工作空间越大;,9设计参数优化,条件数当动平台的z轴与基坐标一致时，在不同截面的中间位置，Jacobian条件数为该界面的最优位形;当六根杆长均处于最长和最短时，Jacobian条件数也接近于整个运动范围的最小值和最大值。条件数与动平台的高度h的关系:条件数随h的增高而变大，机构的控制性能随运动平面的升高而降低，还有一个重要的原因，当杆伸到头的过程中，杆机械系统本身的性能逐渐变差引起的。,支腿,组成上铰(球铰)线性执行器下铰（虎克铰）驱动型式液压驱动电动缸驱动气动缸驱动,洗出算法,洗出算法的功能是利用运动系统有限的运动空间实现飞行器无限运动所实现的运动感觉。由于驾驶员对飞行器运动的感觉是利用人体的前庭器官通过判断比力和角速度来实现的，所以洗出算法的目的是在有限运动空间的条件下所产生的比力和角速度与实际飞行运动中所产生的比力和角速度一致。比力是指人当前的加速度向量与重力向量的差,