六自由度运动平台实时控制的正_反解算法

C A M E O 凯模C A E 案例库

w w w .c a m e o .o r g .c n

C A M E O 凯模C A E 案例库

w w w .c a m e o .o r g .c n

C A M E O 凯模C A E 案例库

w w w .c a m e o .o r g .c n

C A M E O 凯模C A E 案例库

w w w .c a m e o .o r g .c n

六自由度摇摆平台

大黄蜂机器人六自由度摇摆台 大黄蜂机器人有限公司的六自由度平台系统由采用Stewart机构的六自由度运动平台、计算机控制系统、驱动系统等组成。六自由度运动平台（如下图）的下平台安装在地面上，上 平台为运动平台，它由六只电动缸支承，运动平台与电动缸采用六个虎克铰连接，电动缸与固定基座采用六个虎克铰连接，六只电动缸采用伺服电机驱动的电动缸。计算机控制系统通过协调控制电动缸的行程，实现运动平台的六个自由度的运动，即笛卡尔坐标系内的三个平移运动和绕三个坐标轴的转动。

各主要部分简述如下： 本设备主要由以下部分组成：运动上平台、下平台（基座）、电动缸及伺服 电机、驱动器系统、综合控制及监测系统。 各自功能如下： 上平台：是有效载荷的安装基面，提供六自由度的摇摆运动。 下平台：是六自由度摇摆台的安装基面，需要承受足够大的冲击力。 电动缸及伺服电机：通过控制电动缸活塞杆的行程，实现运动平台台体的六自由度运动，共6套。 驱动器系统：接收用户控制指令，通过控制伺服电机的输入，对伺服电机的输出转速和转角进行控制，达到控制电动缸活塞杆出速度和行程的目的，共6套。 综合控制监测系统：硬件为用户计算机，软件为研制方配合开发；同时，它 还对平台的运动过程进行监测，预防和处理系统的异常情况。

平台总体运动能力指标如上表，具体表述如下： a.平台定位精度及重复定位精度为0.5mm及0.1mm； b.平台转动精度及重复转动精度为0.1°及0.05°； c.行程回差小于0.2mm； d.平台X方向运动速度可从0mm/s到250mm/s连续变化；YZ方向运动 速度可从0mm/s到250mm/s连续变化； e.单支杆可承受轴向力不小于700N； f.单支杆的运动速度可从0m/s到250mm/s连续变化； g.平台中位位置固有频率：不小于40Hz； h.机械组件需具有开放性，可拆卸组装； i.机械设计安全系数不小于 2.0，驱动裕度不小于 3.0； j.额定载荷下，全行程往复工作寿命不小于1×104次，存储寿命不小于48月；

六自由度运动平台方案设计报告

编号 密级内部阶段标记 C 会签 校对 审核 批准六自由度运动平台 方案设计 名称

内容摘要： 针对YYPT项目在原理样机出现的问题，对YYPT原理样机从结构设计、伺服系统等方面进行优化设计，以满足设计及使用要求。 主 YYPT 优化 题 词 更改单号更改日期更改人更改办法 更 改 栏

1概述 YYPT原理样机用原库房留存的345厂的直流电机作为动力源，直流驱动器及工控机作为控制系统元件，采用VB软件进行控制软件的编制，因设计及器件选型的原因，导致YYPT原理样机，在速度、精度、运动规律上等几个技术指标无法满足原规定的指标要求，现在此基础上进行优化方案的设计。 2 原理样机技术状态 2.1 原理样机方案 2.1.1 组成 原理样机采用工控机作为系统的控制单元，工控机内配有研华PCI1716和PCI1723作为A/D和D/A模拟量卡，驱动器采用AMC公司的型号为12A8的伺服驱动器，并配有直流可调电源其输出电流可达到150A，采用KH08XX（3）电动缸作为运动平台的六条支腿，电动缸上安装有电阻尺作为位置反馈器件，上平台与电动缸连接采用球笼联轴器，下平台与电动缸连接采用虎克铰链方式。具体产品组成表见表2.1。 序号产品名称型号厂家数量备注 1 电动缸KH08XX（3）西安方元明 6 安装345厂电机 2 电阻尺LTS-V1-375 上海徳测 6 3 驱动器50A8 AMC 6 3 A/D卡PCI1716 研华 1 4 D/A卡PCI1723 研华 1 5 工控机610H 研华 1 6 直流电源 1 2.1.2 结构方案 六自由度运动平台是由六条电动缸通过虎克铰链和球笼万向节联轴器将上、下两个平台连接而成，下平台固定在基础上，借助六条电动缸的伸缩运动，完成上平台在三维空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出各种空间运动姿态。

六自由度平台说明书

技术领域 本发明涉及一种总线型并联六自由度平台，利用总线型控制方式控制伺服电机，经过虎克铰、伺服电动缸的传动使上平台可以模拟各种空间动作。 背景技术 传统的伺服电机控制技术是通过运动控制卡发出脉冲信号和方向信号，驱动伺服电机做不同动作。每一个伺服电机都需要一组对应的脉冲信号和方向信号控制，六自由度平台有六个伺服电机就需要六组信号。用CAN总线控制伺服电机，只需要一台计算机通过CAN总线通信适配卡向总线发送控制信息，伺服驱动器选择需要的信息接收来控制伺服电机，不再需要运动控制卡，节省了硬件和接线，实现了传输信号的数字化。一条CAN总线最多可以有128个节点，一个六自由度平台有六个伺服电机即六个节点，所以一条总线可以控制最多20个六自由度平台。并且总线抗干扰能力强，可以适应恶劣的工作环境。 六自由度运动平台是由六个伺服电机、六个伺服电动缸，上、下各六个虎克铰和上、下两个平台组成，下平台固定在基础上，借助六个伺服电动缸的伸缩运动，完成上平台在空间六个自由度（α，β，γ，X，Y，Z）的运动，从而可以模拟出各种空间运动姿态。六自由度运动平台涉及到机械、伺服电动缸、伺服电机、控制、计算机、传感器，空间运动数学模型、实时信号传输处理等一系列高科技领域，因此六自由度运动平台是控制领域水平的标志性象征。主要包括平台的空间运动机构、伺服系统、控制系统。 发明内容 本发明解决的技术问题是由总线型方式控制伺服电机使平台可以模拟各种空间运动姿态，并且达到精确控制和信息的反馈。 本发明为解决其技术问题采用的方案是：平台包括三部分，分别是控制系统、伺服系统和运动机构。控制模块包括一台计算机、一个CAN总线通信适配卡和一条CAN总线；伺服系统包括六个伺服驱动器和六个伺服电机；运动机构包括十二个虎克铰、六个伺服电动缸和上、下平台。所述上位机与总线通信适配卡连接，CAN总线通信适配卡与CAN总线连接，CAN总线与六台伺服驱动器连接，六台伺服驱动器分别与六台伺服电机连接，伺服电机与伺服电动缸连接，伺服电动缸与虎克铰连接，六个虎克铰和上平台连接，下平台与六个虎克铰连

六自由度平台力学仿真研究

六自由度运动平台动力学仿真研究 陈勇军 （华中光电技术研究所—武汉光电国家实验室，武汉430223） 摘要：针对六自由度运动平台设计过程中遇到的问题，文中运用ADAMS软件对六自由度运动平台运动过程进行仿真研究，并进行可平台的逆运动学和正运动学仿真。仿真结果表明：通过仿真可以检测该机构运动过程中的干涉情况，也可直观再现平台的运动过程。还可求出平台的位置反解和位置正解，大大减少了工作量，缩短了产品的研制周期。 关键字：六自由度运动平台；动力学分析；仿真；正解；反解 Research on Simulation of Dynamic Analysis on Six-DOF Motion Platform CHEN Yongjun （Huazhong Institute of Electro-optics—Wuhan National Laboratory for Optoelectronics，Wuhan 430223，China） Abstract:Due to Keywords: Six-DOF motion platform ; dynamic analysis ; simulation; positive solutions; anti-positive solutions 1 引言 六自由度运动平台通过模拟物体在三个方向的平动和转动，即前后平移、左右平移、上下垂直运动、俯仰、滚转和偏航及复合运动，进而可模拟出各种空间运动姿态。六自由度平台作为一种重要的仿真实验设备，已广泛应用于导弹、飞机、舰船和车辆等领域的模拟训练，还可用来模拟地震的情景，在动感电影、娱乐设备等领域也有应用。六自由度运动平台主要由上下两个平台和六个并联的、可独立自由伸缩的缸组成，其中伸缩缸与平台通过球铰联接，通过改变伸缩缸的长度就可实现上平台的各种空间运动[1]。要准确的控制上平台的运动姿态就需要精确的控制六个缸的运动，这样就要求我们了解六自由平台的位置反解和位置正解的算法。杨永立运用欧拉角、旋转变换的方法推导出位置反解方程，并介绍了数值迭代法进行位置正解的过程[2]。李维嘉提出了采用虚拟连杆对结构进行简化，进而求解六自由度并联运动机构正向解的方法[3]。但到目前位置还没有一种非常高效的求六自由度平台位置正解的算法。近年来，随着计算机的快速发展，仿真软件已经成为设计产品过程中的一种重要工具，在运动学仿真方面也出现了许多仿真软件，这其中的杰出代表是ADAMS软件。本文提出了采用ADAMS软件对六自由度运动平台的运动过程进行仿真研究，使平台运动的位置反

六自由度平台实验报告

六自由度平台实验报告 机械电子工程系张梦辉21525074 一、实验简介 实验对象为一个六自由度平台，每个自由度的运动均由一个永磁式直流电机驱动，实验要求对其中一个电动缸进行位置控制，位置由一个滑变电阻式的位移传感器反馈回的电压信号确定，驱动则是通过研华的PCI1716L的数字输出实现，控制软件采用Labview8.6。 二、实验装置 PC机一台 研华PCI1716L多功能板卡一个 PCI总线一根 固态继电器板一块 220V AC—24VDC变压器三个 直流电动机六个 三、实验台介绍 六自由度运动平台是由六支电动缸，上、下各六只万向铰链和上、下两个平台组成，下平台固定在基础上，借助六只电动缸的伸缩运动，完成上平台在空间六个自由度（α，β，γ，X，Y，Z）的运动，从而可以模拟出各种空间运动姿态。六自由度运动平台涉及到机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理等一系列高科技领域，因此六自由度运动平台是机电控制领域水平的标志性象征。主要包括平台的空间运动机构、空间运动模型、机电控制系统。 本实验台，PC机作为板卡和人的接口，通过在PC机上编程来控制板卡发送数字信号和采集位置信号。将PCI多功能卡设置为设备0，选择PCI板卡的模拟信号输入口AI4口来采集2号缸的位置信号，通过PORT1号口来控制2号缸对应直流电机的正转、反转和停止。通过数字信号输出口发送开关量来控制固态继电器的开和闭，固态继电器导通的话，则接通直流电动机，直流电动机开始运行，这时候，电动缸就会朝着指定方向运行，并且到达指定的位置。

实验中用到的接口的说明： AI0-AI5 模拟信号输入口，用来采集六个缸的位置信号；AIGND 模拟信号公共地 DO0-DO11 数字信号输出口，用来控制六个缸的运动 （其中DO11-DO10 分别控制1号缸的正反转 DO09-DO08 分别控制2号缸的正反转 DO07-DO06 分别控制3号缸的正反转 DO05-DO04 分别控制4号缸的正反转 DO03-DO02 分别控制5号缸的正反转 DO01-DO00 分别控制6号缸的正反转 DGND 数字输出信号公共地

六自由度电动

1：系统组成 六自由度平台系统是由六自由度运动平台、计算机控制系统、驱动系统等组成。下平台安装在地面的固定基座基上，上平台为支撑平台。计算机控制系统通过PLC控制驱动器从而控制电机以协调控制电动缸的行程，实现运动平台的六个自由度的运动，。 各主要部分简述如下： 1）运动平台 上平台：连接需要被模拟动作的机构 上铰链：双回转轴的虎克铰结构，用于连接上平台与电动缸的活塞杆。 下铰链：单虎克铰结构，用于连接固定基座与电动缸的筒体。 下平台：安装固定基座。 2）计算机控制系统硬件 运动控制计算机（伺服控制单元）：实现平台系统启动/停止、接收上位机发来的位姿控制信息、对电动缸进行运动控制、监控伺服电机驱动器的工作状态、监控系统的运动状态、完成故障处理以及安全保护工作。 信号调理单元：完成与平台系统运动状态相关的各种传感器信号、测试信号和数字I/O信号的调理，以及伺服驱动器的驱动等。 3）系统控制软件 运动控制计算机的软件包括运动控制软件和逻辑控制软件。 2：系统工作原理 平台的控制系统为分层控制结构，监控单元负责人机界面交互，接受用户操作指令。并将控制信号下达给实时控制计算机。 首先，用户输入期望的运动参数（运动平台位姿、速度或加速度），如X向正弦运动。该运动参数传输给运动控制计算机，运动计算机通过运动学反解计算出六个电动缸的运动参数（电动缸位移量）；然后，运动计算机根据六支电动缸运动参数和六个电动缸的位移反馈量，驱动六个伺服驱动器，实现六个电动缸闭环位置控制，使六个电动缸达到所要求的位移量，那么运动平台也就达到了所期望的运动姿态。 六自由度运动平台，由于有极为广阔的应用前景，六自由度运动平台是由六支油缸，上、下各六只万向铰链和上、下两个平台组成，下平台固定在基础上，借助六只油缸的伸缩运动，完成上平台在空间六个自由度（X，Y，Z）的运动，从而可以模拟出各种空间运动姿态，可广泛应用到各种训练模拟器如飞行模拟器、舰艇模拟器、海军直升机起降模拟平台、坦克模拟器、汽车驾驶模拟器、火车驾驶模拟器、地震模拟器以及动感电影、娱乐设备等领域，甚至可用到空间宇宙飞船的对接，空中加油机的加油对接中。在加工业可制成六轴联动机床、灵巧机器人等。由于六自由度运动平台的研制，涉及机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理、图形显示、动态仿真等等一系列高科技领域，因而六自由度运动平台的研制变成了高等院校、研究院所在液压和控制领域水平的标志性象征。 售后说明及建议

并联六自由度运动平台

并联六自由度运动平台 1．概述 并联六自由度运动平台通过六个驱动缸（伺服缸或电动缸）的协调伸缩来实现平台在空间六个自由度的运动，即平台沿x、y、z向的平移和绕x、y、z轴的旋转运动（包括垂直、水平、横向、俯仰、侧倾和旋转六个自由度的运动），以及这些自由度的复合运动。并联六自由度运动平台可用于机器人、飞行模拟器、车辆驾驶模拟器、新型加工机床、及卫星、导弹等飞行器、娱乐业的运动模拟（动感电影摇摆台）、多自由度振动摇摆台的精确运动仿真等。 图0-1：六自由度及其坐标系定义图 我公司通过自行设计、安装调试，并开发控制软件，同时采用进口关键件对并联六自由度运动平台进行研究开发，目前已完成多套六自由度运动平台应用，典型应用有列车风档液压仿真试验台、F1国际赛车运动仿真台、汽车驾驶模拟器、飞机和飞碟运动模拟器、振动谱试验、海浪模拟试验等。 六自由度运动平台的研制，涉及机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理、图形显示、动态仿真等一系列高科技领域，是液压及控制技术领域的顶级产品。 2．系统组成 2.1液压伺服类 典型的液压式并联六自由度运动平台主要由机械系统、液压系统、控制系统硬件和控制系统软件四部分组成。

机械系统主要包括：承载平台、上下连接铰链、固定座。 液压系统主要包括：泵站系统、伺服阀、驱动器、伺服油缸和阀块管路。 控制系统硬件主要包括：实时处理器、伺服控制单元、信号调理单元、监控单元和泵站控制单元。 控制系统软件包括：实时信号处理单元、实时运算单元、伺服控制和特殊要求处理单元。 2.2 电动伺服类 电动式并联六自由度运动平台则将伺服油缸用电动缸代替，而伺服阀、泵站系统及阀块管路等则相应取消，增 加运动控制单元。具有系统简洁、响应速度快等优点，是多自由度平台今后重点发展的方向。 3．主要技术参数 以下参数为液压类平台典型值，具体可按用户要求设计制造。 3.1平台主要参数 平台最大负载：静态≥2000KG，动态≥3000KG。 上平台球铰分布园直径1400mm，相邻球心距离157mm； 下平台球铰分布园直径1600mm，相邻球心距离167mm； 伺服缸最小球铰球心距离800mm，最大长度1200mm；（采用Φ63/45~400缸体）。 平台初始高度约700mm。 3．2 泵站技术指标 额定流量：90L/min 最大系统压力：12Mpa； 泵站电机功率：22KW； 空间尺寸：1400×1200×1320 3.3 运动参数 伺服缸运动速度≥200mm/S；有效行程≥400mm。 主要运动参数如下表：

六自由度

物体在空间具有六个自由度，即沿X、Y、Z三个直角坐标轴方向的移动自由度和绕这三个坐标轴的转动自由度。因此，要完全确定物体的位置，就必须清楚这六个自由度。 六自由度运动平台是由六支作动筒，上、下各六只万向铰链和上、下两个平台组成，下平台固定在基础上，借助六支作动筒的伸缩运动，完成上平台在空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出各种空间运动姿态。可广泛应用到各种训练模拟器如飞行模拟器、舰艇模拟器、海军直升机起降模拟平台、坦克模拟器、汽车驾驶模拟器、火车驾驶模拟器、地震模拟器以及动感电影、娱乐设备等领域，甚至可用到空间宇宙飞船的对接，空中加油机的加油对接中。在加工业可制成六轴联动机床、灵巧机器人等。由于六自由度运动平台的研制，涉及机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理、图形显示、动态仿真等等一系列高科技领域，因而六自由度运动平台的研制变成了高等院校、研究院所在液压和控制领域水平的标志性象征。 空间运动的目标是实现平台在空间运动的三个姿态角度和三个平动位移，即俯仰、滚转、偏航、上下垂直运动、前后平移和左右平移，及六个姿态的复合运动姿态。而空间目标是通过六个液压缸的行程实现的，这就需要一个空间的运动模型完成空间运动的转换，假设空间运动的目标俯仰、滚转、偏航、上下垂直位移、前后平移和左右平移用α，β，γ，X，Y，Z表示，六个油缸的行程用 L(i), (i＝1、2、3、4、5、6)表示。整个运动模型如下： L（i）＝TT（α，β，γ，X，Y，Z） 其中，TT是一个空间转换矩阵模型。由此实时算出每一运动时刻液压油缸的行程。液压油缸的理论行程再通过D/A接口的转换，给出实际行程值。 多自由度运动控制 多自由度控制系统中，自由度最多为六自由度，并且六自由度运动控制难度最大，设备及系统最复杂，下面主要介绍我公司设计、生产的六自由度运动台。 六自由度运动平台是由六支直线伺服电动缸，上、下各六只万向铰链和上、下两个平台组成，下平台固定在基础上，借助六只伺服电动缸）执行器）的伸缩运动，完成上平台在空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出

六自由度运动平台设计方案

六自由度运动平台设计 方案 1概述 YYPT原理样机用原库房留存的345厂的直流电机作为动力源，直流驱动器及工控机作为控制系统元件，采用VB软件进行控制软件的编制，因设计及器件选型的原因，导致YYPT原理样机，在速度、精度、运动规律上等几个技术指标无法满足原规定的指标要求，现在此基础上进行优化方案的设计。 2 原理样机技术状态 2.1 原理样机方案 2.1.1 组成 原理样机采用工控机作为系统的控制单元，工控机内配有研华PCI1716和PCI1723作为A/D和D/A模拟量卡，驱动器采用AMC公司的型号为12A8的伺服驱动器，并配有直流可调电源其输出电流可达到150A，采用KH08XX（3）电动缸作为运动平台的六条支腿，电动缸上安装有电阻尺作为位置反馈器件，上平台与电动缸连接采用球笼联轴器，下平台与电动缸连接采用虎克铰链方式。具体产品组成表见表2.1。 序号产品名称型号厂家数量备注 1 电动缸KH08XX（3）西安方元明 6 安装345厂电机 2 电阻尺LTS-V1-375 上海徳测 6 3 驱动器50A8 AMC 6 3 A/D卡PCI1716 研华 1 4 D/A卡PCI1723 研华 1 5 工控机610H 研华 1

6 直流电源 1 2.1.2 结构方案 六自由度运动平台是由六条电动缸通过虎克铰链和球笼万向节联轴器将上、下两个平台连接而成，下平台固定在基础上，借助六条电动缸的伸缩运动，完成上平台在三维空间六个自由度（X ，Y ，Z ，α，β，γ）的运动，从而可以模拟出各种空间运动姿态。 图1 六自由度平台外形图 a ）球笼联轴器（如图2所示） 采用球笼铰链与上平面连接。球笼铰链结构简单、体积小、运转灵活、易于维护。 初选球笼铰链型号BJB （JB/T6139-1992），公称转矩Tn=2000N/m ，工作角度40度，外径D=68mm ，轴孔选用圆柱孔d=24mm ，总长度L1=148mm ，转动惯量为0.00008kg.m 2，重量5kg 。 球笼联轴器 电动缸 虎克铰链 上动平台 下静平台

六自由度电动平台控制系统设计研究

３０ 收稿日期：２０１１－０９－０５ 六自由度电动平台控制系统设计研究 金　伟１ ，杨　斌 ２ （１兰州城市学院培黎石油工程学院 甘肃兰州，７３００７０） （２兰州城市学院 甘肃兰州，７３００７０） 摘　要：采用多轴运动控制器ＭＡＣ作为控制主体，基于“工控机＋运动控制卡”的模式，构建了一个开放式的六 自由度电动平台控制系统。实现了六自由度电动平台的基本控制功能。建立了六自由度电动平台的故障保护系统及故障监控系统，并详细介绍了系统组成部分及实现过程。 关键词：故障保护系统；故障监控系统；六自由度电动平台；ＭＡＣ Abstract: This dissertation applies the current high-powered servo controller MAC, based on “IPC+MAC ”，constructed an open numerical control system of 6-dof electric platform. The control software is designed with the functional modularization. The basic control functions of 6-dof electric platform are realized.Fault Protection System and Fault Monitoring System is established, and the components and the implementation process is described in detail. Key words: platform ; Fault protection system ; Fault monitoring system ; 6-dof electric- MAC 中图分类号：ＴＰ１３ 文献标识码：Ａ 文章编号：１００１－９２２７（２０１１）０６－００３０－０３ ０ 绪　论 近年来由于电机伺服系统性能的大幅提升以及电动缸控制性能的优越性，在小载荷和高精度控制领域电机驱动平台系统有取代液压驱动平台系统的趋势，因此开展对六自由度电动平台运动系统的研究有着非常重大的意义与巨大的发展前景。 本论文围绕搭建六自由度电动平台的控制系统实现实时运动控制而展开。本控制系统采用“工控机＋多轴运动控制卡”作为硬件基础，搭建了本六自由度电动平台的硬件控制系统；开发出六自由度电动平台的控制软件，建立起六自由度电动平台软件控制系统，实现六自由度电动平台的实时控制。构建六自由度电动平台故障保护系统及故障监控系统，实现电动平台的基本故障保护与远程故障监控。 １ 六自由度电动平台的结构与特点 六自由度电动平台由下平台（固定底座）、运动平台、虎克铰和六个作动器（伺服电动缸）组成。伺服电动缸通过虎克铰以并联的形式将固定底座和运动平台连接起来，因而六个伺服电动缸均可独立地伸缩。通过六个伺服电动缸的协调伸缩，相对于固定下平台，运动上平台就可以灵活实现空间六个自由度方向上的位姿运动。该结构具有以下特点： （ｌ）同串联机构的悬臂梁比较，六自由并联机构的运动平台由６个作动器同时支撑，结构稳定，刚度较大，且承载能力大； （２）串联式机器人的传动系统及驱动电动机大都固定在运动的大小臂上，导致系统惯性增加，动力性能恶化，而并联式则可将驱动电机置于固定底座上，减小了运动负 荷，动力性能较好。 （３）串联机构的误差是相关运动关节误差的积累和放大，因此误差大而精度低。而并联机构则误差趋向平均化，不存在如此的误差积累和放大关系，因而误差小、精度高； （４）并联式机器人组成结构往往为对称式，其各向同性好； （５）在运动学分析方面，串联机构正解容易，反解非常困难，而并联机构则与之相反，正解困难，反解容易。多自由度机构运动过程中，需要进行实时反解运算，并联式容易实现，而串联式却十分不易。２ 控制系统硬件体系结构２．１　控制系统逻辑结构 在自动控制系统中，输出量以一定准度随着输入目标值的变化而变化的系统称为伺服系统。六自由度电动平台硬件控制系统的目标是：输入预定的目标位姿曲线，驱动伺服电机使电动缸推杆按照位姿曲线进行伸缩运动。因此本文要搭建的六自由度电动平台控制系统就是伺服系统。要实现对六自由度平台良好的控制，构建一个精度高，响应快速，稳定性好的伺服系统显然尤为关键。电动平台硬件系统由工控机、运动控制卡、数字式直流伺服放大器、伺服电机及检测原件组成。 本系统以研华工控机（ＩＰＣ）作为上位机，以多轴运动控制器ＭＡＣ为下位机，电气伺服部分采用富士交流伺服电机，机械传动部分采用高精密滚珠丝杠。控制软件通过ＭＡＣ系列运动控制卡发送脉冲给富士电机伺服放大器，从而驱动伺服电动缸按照给定轨迹完成伸缩运动。在电动缸运动的同时，通过伺服电机中编码器将实际位置脉冲信号反馈到ＭＡＣ运动控制卡的接口，从而更准确地控制动平台 六自由度电动平台控制系统设计研究 金　伟，等

六自由度运动平台正解(几何法)

六自由度运动平台正解(几何法) 1. 对上平台（运动平台）进行扩展，示意如下： Pic 1 上平台示意图 由于确定一个平面状态只需要三个点，因此获得C1,C2,C3坐标，即可确定平面状态。 如图，h1,h2均为已知量，设L h k /1=，212*h h L +=，),,(i i i i z y x C =。 设下平台各点坐标为),,(i i i i s n m B =，设各轴长为i i i l B A =。 于是问题简化为：已知：L k l B i i ,,,，求解i C 。 2. 建立方程组 2.1 i l 相关 对于1l ，分析如下：

Pic 2 单轴示意图 由图可知：向量3111111111*C C k C B A C C B A B +=+=， 即，1111111131313),,(),,(l s z n y m x z z y y x x k =---+--- 所以： )1......(0])1([])1([])1([21211321132113=---++--++--+l s z k kz n y k ky m x k kx 同理有： ) 6......(0])1([])1([])1([)5......(0])1([])1([])1([)4......(0])1([])1([])1([) 3......(0])1([])1([])1([) 2......(0])1([])1([])1([2626312631263125253225322532242423242324232323212321232122221222122212=---++--++--+=---++--++--+=---++--++--+=---++--++--+=---++--++--+l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx 2.2 L 相关 ) 9......(0)()()()8......(0)()()()7......(0)()()(222322322322312312312221221221=--+-+-=--+-+-=--+-+-L z z y y x x L z z y y x x L z z y y x x 3. 求解 3.1 联立方程组（1）-（9），牛顿迭代法解方程组，即可求的i C ， 取0>i z ，可得唯一解。 3.2 由i C 求出平台姿态 根据实际情况，建立坐标系如下

六自由度运动平台的仿真研究

六自由度运动平台的仿真研究 天津工程机械研究院 杨永立 摘要：本文分析了六自由度运动平台分别采用球铰链和万向节铰链进行连接时的自由度，运用欧拉角、旋转变换的方法推导出位置反解方程，介绍了数值迭代法进行位置正解的过程。 关键词：并联，局部自由度，位置反解，位置正解。 1. 简介 运动平台按结构形式可分为串联和并联两大类。与串联形式相比，并联形式具有刚度大、承载能力强、结构简单、运动负荷小、能实现包括横移、纵移、升沉等多个自由度运动等特点。同时，串联形式的优点也很明显，其具有运动空间大，测量精度高，运动、受力分析相对简单、控制、测量的实现相对容易，且每个自由度都能独立运动等特点。 六自由度运动平台（如图1所示）是由六条油缸通过万向节铰链（或球铰链）将上、下两个平台连接而成，下平台固定在基础上，借助六条油缸的伸缩运动，完成上平台在三维空间六个自由度（X， Y，Z，α，β，γ）的运动，从而可以 模拟出各种空间运动姿态。 2. 自由度的确定 若在三维空间有n个完全不受约束 的物体，任选其中一个作为固定参照物， 因每个物体相对参照物都有6个运动自 由度，则n个物体相对参照物共有6(n-1) 个运动自由度。若在所有物体之间用运 动副联接起来组成机构，设第i个运动副 的约束为u i（1到5之间的整数），如果 运动副的总数为g，则机构的自由度M为：

∑=--=g i i u n M 1)1(6 利用上述公式计算一下如图1所示运动平台(采用球铰链)的自由度数。将油缸分解为缸筒和活塞杆，则总的构件数n=14，油缸与上下平台之间的连接为12个球铰链（约束为3），缸筒和活塞杆构成6个既可以相对移动，又可以相对转动的运动副（约束为4），则平台的自由度M 为： ∑=--=g i i u n M 1)1(6=6 (14－1)－(3×12＋4×6)=18 计算结果出人意料，平台似乎无法只通过六条油缸进行驱动。但是，如果保持上平台和缸筒固定不动，由球铰链的特性可知，活塞杆仍然可以相对其轴线转动；同理，缸筒也具有同样的效应。实践证明，这种转动并不影响上平台的空间运动姿态，因此属于局部自由度。 在六自由度运动平台的实际设计中，由于球铰链 的刚度差，结构不稳定，所以一般采用万向节铰链（如 图2所示，约束为4）来代替图1中的球铰链，则自由 度M 为： ∑=--=g i i u n M 1)1(6=6 (14－1)－(4×12＋4×6)=6 3. 六自由度运动平台空间姿态的解算 要实现对平台空间姿态的控制和测量，必须掌握它两个方向上的解算方法，即位置反解和位置正解。 3.1 位置反解（逆向解）： 已知输出件的位置和姿态，求解输入件的位置称为机构的位置反解。在运动平台的实际应用当中，用户所给定的一般都是平台的六个空间姿态参数X ，Y ，Z ，α，β，γ，然而要实现对平台的控制，需要的是六条油缸的长度L 1、L 2…L 6，这正好是已知输出求输入，属于位置反解。也就是说，要实现对平台空间姿态的控制，就必需推导出平台的位置反解方程。 如图1所示，在上平台建立动坐标系o-xyz ，在下平台建立静坐标系O-XYZ ， 图2 万向节铰链

6自由度控制算法

由于六自由度位置姿态调整平台动力学特性和串联机器人是相通的,所以可以借鉴。增强型PD控制器,这种控制器是在一个线性PD控制的基础上加上沿期望轨迹计算的名义动力学前馈部分以及一个非线性补偿部分,它的最大优点是可以根据规划好的期望轨迹离线计算前馈补偿部分,从而降低实时计算的计算量。计算力矩控制方法,它通过计算力矩的方式控制非线性系统沿期望轨迹运动,如果机器人动力学模型是准确的,计算力矩控制器可以实现动态解耦,并得到一个指数稳定的闭环动力方程,从而实现跟踪误差的指数收敛。 在并联机器人的控制策略中,除了常用的PID控制之外,还有自适应控制，滑模变结构控制，鲁棒控制以及智能控制等控制方法。 基于滑模控制的方法 在具有不确定性的系统的研究和应用中，滑模控制一直是一个非常有效的控制方法。滑模控制也叫变结构控制，其本质是一类特殊的非线性控制，且非线性表现为控制的不连续性。这种控制策略与其他控制的不同之处在于系统的“结构”不是一成不变的，而是可根据系统当前的状态有目的地不断变化。对于具有信号传输时延的交互控制遥操作系统，也可以应用滑模控制来实现。只要知道时延大小，滑模控制就可以实现变时延情况下的遥操作系统的稳定控制。由于滑动模态与系统对象参数及扰动无关，因此滑模控制具有响应快、对应参数变化及扰动不灵敏、无需系统在线辨识、物理实现简单等优点。 鲁棒控制 由于遥操作系统中操作对象的不确定性，以及操作任务的实时变化，导致遥操作系统的特性和参数随工作状态和工作环境的变化而变化，这样就无法得到精确的描述遥操作系统特性的数学模型，给控制系统的设计带来困难。鲁棒控制设计的目标就是在模型不精确和存在其他变化因素的条件下，使系统仍能保持预期的性能。因此鲁棒控制在遥操作系统中发挥了巨大作用，它较大程度地消除了主观上认识的模型和真实的被控对象之间的误差和不确定性。 基于干扰观测器(DOB)的鲁棒运动控制方法由Ohnishi提出,目前广泛应用于各类电动高精度机械伺服系统"干扰观测器设计基于被控对象的开环数学模型,其基本思想是将外部力矩干扰及模型参数变化造成的实际对象与名义模型输出的差异,统统等效到控制输入端,即观测出等效干扰,在控制中引入等量的补偿,实现对各种干扰的完全抑制,同时还可以减弱非线性环节对伺服系统性能的影响,具有很强的鲁棒性。 六自由度并联平台运动控制器的设计可以分为基于铰接空间控制和基于工作空间控制两大类。 基于铰接空间的控制器设计主要依靠平台机构的运动学关系和驱动装置的动态模型,而不考虑六自由度平台的动力学模型,它假设六个液压缸是独立、无耦合的关系,对每个液压伺服系统分别设计控制器而不用考虑其它关节的影响,这就使得并联平台的控制器设计任务转化为一系列单轴伺服系统的控制器设计。 基于工作空间的控制器设计则需要进行平台动力学分析,建立整个并联平台系统的动力学模型,在给定了平台期望的运动轨迹后,求出按照期望轨迹运动所需的力或力矩,然后控制各个液压伺服系统的驱动装置输出所求出的力或力矩,从而使平台按照期望轨迹运动。 常规PID控制 常规PID目前是最常用的工业控制方法，PID控制器各校正环节的作用

六自由度机器人控制系统设计

1前言 1.1 焊接机器人的发展历史与现状 现代机器人的研究始于20世纪中期，其技术背景是计算机和自动化的发展，以及原子能的开发利用。美国原子能委员会下属的阿尔贡研究所为解决可代替人进行放射性物质的处理问题，在1947年研制了遥控式机械手臂；1948年又相继开发了电气驱动式的主从机械手臂，从而解决了对放射性物质的进行远距离操作的问题。1954年，美国科学家戴沃尔最先提出工业机器人的概念，并申请了新的专利。其主要特点是借助伺服技术来控制机器人的关节，并利用人手对机械手臂进行动作示教，机械手臂能实现人物动作的记录和再现。这就是示教再现机械臂，现在所用的机械手臂差不多都采用这种控制方式。伴随着现代社会的发展，为了提高生产效率，稳定和提高产品的质量，加快实现工业生产机械化，改善工人劳动条件，已经大大改进了机械手臂的性能，并大量应用于实际生产中，尤其是在高压、高温、多粉尘、高噪音和重度污染的场合。焊接机器人的诞生可以追溯到上世纪70年代，是由日本发那科（FANUC）公司生产的小型机器人改进的，受限于当时的技术手段以及高昂的造价，使得当时的焊接机器人不能得到很好的应用。机械手臂是一种工业机器人，它由控制器、操作机、检测传感装置和伺服驱动系统组成，是一种可以自动控制、仿人手操作、可以重复编程、可以在三维空间进行各种动作的自动化生产设备。机械手臂首先是在汽车制造工业中使用的，它一般可进行焊接、上下料、喷漆以及搬运。它可代替人们进行从事繁重、单调的重复劳动作业，并且能够大大改善劳动生产率，提高产品的质量[1]。 到了90年代初，随着计算机技术、微电子技术、网络技术等的快速发展，机器人技术也得到了飞速发展。工业机器人的制造水平、控制速度和控制精度、可靠性等不断提高，而机器人的制造成本和价格却不断下降。在西方国家，由于劳动力成本的提高为企业带来了不小的压力，而机器人价格指数的降低又恰巧为其进一步推广应用带来了契机，采用机器人的利润显然要比采用人工所带来的利大，使得焊机机器人得到了推广，同时技术的进步也使得焊机机器人技术得到很大提高。 进入新世纪之后，由于各国对焊接机器人的不断重视，使得焊接机器人技术取得了很大的进步。同时由于其焊机精度及更低的生产成本，也使得它得到了越来越多的应用。目前，焊接机器人主要用于装卸、搬运、焊接、铸锻以及热处理等方面，无论数量、品种和性能方面都还不能满足工业生产发展需要。在一些特殊的行业，使用它来代替人工操作的，主要是在危险作业、多粉尘、高温、噪声、工作空间小等的不适于人工作业的环境。 1.2 焊接机器人发展趋势

六自由度运动平台方案设计分析报告doc

六自由度运动平台方案设计报告doc

————————————————————————————————作者：————————————————————————————————日期：

编号 密级内部阶段标记 C 会签 校对 审核 批准六自由度运动平台 方案设计 名称

内容摘要： 针对YYPT项目在原理样机出现的问题，对YYPT原理样机从结构设计、伺服系统等方面进行优化设计，以满足设计及使用要求。 主 YYPT 优化 题 词 更改单号更改日期更改人更改办法 更 改 栏

1概述 YYPT原理样机用原库房留存的345厂的直流电机作为动力源，直流驱动器及工控机作为控制系统元件，采用VB软件进行控制软件的编制，因设计及器件选型的原因，导致YYPT原理样机，在速度、精度、运动规律上等几个技术指标无法满足原规定的指标要求，现在此基础上进行优化方案的设计。 2 原理样机技术状态 2.1 原理样机方案 2.1.1 组成 原理样机采用工控机作为系统的控制单元，工控机内配有研华PCI1716和PCI1723作为A/D和D/A模拟量卡，驱动器采用AMC公司的型号为12A8的伺服驱动器，并配有直流可调电源其输出电流可达到150A，采用KH08XX（3）电动缸作为运动平台的六条支腿，电动缸上安装有电阻尺作为位置反馈器件，上平台与电动缸连接采用球笼联轴器，下平台与电动缸连接采用虎克铰链方式。具体产品组成表见表2.1。 序号产品名称型号厂家数量备注 1 电动缸KH08XX（3）西安方元明 6 安装345厂电机 2 电阻尺LTS-V1-375 上海徳测 6 3 驱动器50A8 AMC 6 3 A/D卡PCI1716 研华 1 4 D/A卡PCI1723 研华 1 5 工控机610H 研华 1 6 直流电源 1 2.1.2 结构方案 六自由度运动平台是由六条电动缸通过虎克铰链和球笼万向节联轴器将上、下两个平台连接而成，下平台固定在基础上，借助六条电动缸的伸缩运动，完成上平台在三维空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出各种空间运动姿态。

Stewart平台是六自由度并联机构

一、设计（论文）目的、意义 设计目的及意义 Stewart平台是六自由度并联机构的基础平台。Stewart平台具有诸多优良特性，它在许多领域得到了广泛应用。六自由度运动平台由于应用场合不同，采用不同的驱动方式。目前，这种并联机构驱动方式主要包括电机驱动滚珠丝杠驱动方式、阀控液压缸驱动方式、气动人工肌肉驱动方式、电动液压混合执行器驱动方式、压电陶瓷驱动方式、电机驱动滑轮钢索驱动方式等。阀控液压缸驱动方式的优点是刚度大、抗干扰能力强、功率-重量比和力矩-惯量比大、响应速度快、系统频带宽。对该平台的驱动机构设计对于深刻理解并联机床和运动模拟器的机理具有重要的意义。 二、设计（论文）内容、技术要求（研究方法） 设计内容： 对Stewart平台的运动学参数进行了理论分析和计算。重点分析了动平台的位置、速度和加速度和支撑杆的相应参数之间的关系。 对Stewart平台的驱动机构进行了设计和校核,并完成了平台的各个组件的设计。 三、设计（论文）完成后应提交的成果 （一）计算说明部分 设计说明书字数在1.5万字以上（说明书一式1份）。 （二）图纸部分 1、装配图A0一张。 2、零件图若干张 3、总折合图纸当量A0三张。

四、设计（论文）进度安排 2015年03月02日-2015年03月20日确定题目，下达任务书；学生调研、收集、查阅资料，完成 开题报告。 2015年03月21日-2015年03月30日平台的方案、总体布局及工作原理分析。 2015年04月01日-2015年05月15日结构组件进行综合性设计，其中包括液压缸组件设计、相 关阀设计等。 2015年05月16日-2015年06月06日整体装配图的绘制以及相关设计计算的整理 2015年06月06日-2015年06月14日准备答辩。 五、主要参考资料 1刘文涛.并联机床性能分析与研究[D]. 哈尔滨工业大学博士学位论文，2010 2 李洪人.液压控制系统[M]. 国防工业出版社，2009 3张尚盈. 液压驱动并联机器人力控制研究[J]. 哈尔滨:哈尔滨工业大学, 2009. 4梁军,付铁. 基于Stewart平台的并联机床刚度分析[J]. 现代制造工程, 2008 5文福安,梁崇高,廖启征. 并联机器人机构位置正解[J]. 中国机械工程, 2009 6黄真,孔令富,方跃法. 并联机器人机构学理论及控制[M]. 北京:机械工业出版社,2007 7熊有伦, 丁汉, 李恩沧. 机器人学[M]. 北京: 机械工业出版社, 2012. 8赵强. 六自由度舰艇运动模拟器的优化设计及性能分析[M]. 哈尔滨工业大学, 2010 9黄真,杜雄. 3 /62SPS型Stewart机器人的一般线性奇异分析[J]. 中国机械工程2010 10吴江宁，骆涵秀，李世伦.并联式六自由度电液平台的控制与应用[J]. 机床与液压，2006年第6期 六、备注 指导教师签字： 年月日教研室主任签字： 年月日

六自由度位姿调节平台控制系统设计

六自由度位姿调节平台控制系统设计 专业：机械设计制造及其自动化学生：徐瑞 指导老师：朱兴龙 完成时期：2015年6月1日 扬州大学机械工程学院

摘要 六自由度平台在生活和实验设备得到了广泛的应用，例如各种训练模拟器如飞行模拟器、舰艇模拟器、海军直升机起降模拟平台、坦克模拟器、汽车驾驶模拟器、火车驾驶模拟器、地震模拟器以及动感电影、娱乐设备等领域，甚至可用到空间宇宙飞船的对接，空中加油机的加油对接中，在加工业可制成六轴联动机床、灵巧机器人等。为其他试验设备提供了一个可以进行各种姿态调节的支撑平台，方便其他各种实验的展开。由于六自由度运动平台的研制，涉及机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理、图形显示、动态仿真等等一系列高科技领域，因而六自由度运动平台的研制变成了高等院校、研究院所在液压和控制领域水平的标志性象征。同时平台的姿态能够实时调节、精确度自动化程度高等优点。近些年来，对于六自由度平台的控制得到了关注和研究。本文将针对实验室现有的调节平台，设计其控制系统，使位置、姿态调节更加方便快捷。首先需要进行控制系统总体方案论证，确定可行的总体方案。同时在详细了解实验室现有的调节平台的结构的基础上，根据相应的性能要求确定电机、驱动器、控制器型式，建立了六自由度位姿调节平台的运动学模型，进而建立了六自由度位姿调节平台的运动学方程，设计控制系统线路图，重点考虑电机运动到极限位置时“卡死”问题，设置加以控制，最后采用VC++6.0开发工具，在Windows环境中对控制软件进行功能开发，实

现电动、自动功能，解决电机运动到极限位置时“卡死”问题。 关键字: 六自由度位姿调节平台；极限位置；运动学模型；行程开关 ABSTRACT Six degrees of freedom platform and experiment equipment has been widely used in life, such as all kinds of training simulator such as flight simulator, ship simulator, the navy helicopter landing simulation platform, the tank simulator, vehicle driving simulator, the train driving simulator, the earthquake simulator and action movies, entertainment and other fields, even available space spacecraft docking, refueling tanker docking.In processing can be made into six axis linkage