六自由度测试系统
六自由度平台控制流程
六自由度平台控制流程
一、设计阶段
1.确定平台运动范围
(1)确定平台的工作空间尺寸
(2)确定平台的最大移动范围
2.选择控制系统
(1)确定控制系统的类型
(2)选择适合的控制器
二、运动学建模
1.建立平台的运动学模型
(1)确定平台的坐标系
(2)建立运动学方程
2.运动学分析
(1)分析平台的各个自由度运动关系
(2)计算各关节的运动学参数
三、控制器设计
1.PID控制器设计
(1)确定PID控制器参数
(2)进行闭环控制设计
2.轨迹规划
(1)设计平台的运动轨迹
(2)确定平台的运动速度和加速度
四、软硬件实现
1.编写控制程序
(1)使用编程语言编写控制算法(2)软件实现运动控制
2.硬件连接
(1)连接传感器和执行器
(2)配置控制器和驱动器
五、系统调试
1.运动测试
(1)进行平台的手动控制测试
(2)检查各个自由度的运动是否正常2.控制效果验证
(1)进行自动控制测试
(2)验证控制效果和精度
六、性能优化
1.参数调整
(1)调整控制器参数
(2)优化控制算法
2.系统稳定性分析
(1)进行系统稳定性分析(2)确保平台运动稳定可靠
六自由度液压平台控制
六自由度液压平台控制
摘要:根据六自由度运动平台性能特点,对平台进行了基于位置反解的轨迹规划,并对平台控制系统硬件和软件模块进行了分析,以B&R 可编程控制器为结构
设计了六自由度平台运动控制系统。采用该控制系统,对平台进行了位置跟踪和
轨迹跟踪性能测试试验,试验结果证明了模型的正确性及基于模糊神经网络整定
的PID控制的工程可行性和有效性,为今后对液压六自由度运动平台的进一步深
入研究提供一个便捷高效的平台。
关键词:六自由度;控制系统;运动平台
随着自动化技术的发展和自动化程度的不断提高,对液压运动平台系统的稳定性、快速性、准确性、自适应性和鲁棒性等控制品质提出了更高的要求。一般情
况下,传统型控制器如PID控制器、最优化控制器和自适应控制器等就难以得到满
意的控制效果;而人工智能型控制器能实现满意的控制效果,这类控制器不依赖于
被控系统的精确数学模型,而依赖于人的经验知识,或者依赖于系统的输入与输出
之间的非线性映射模型。迭代学习控制(ILC)就具有人工智能特性,是处理不确定量
的一种有效途径,它需要信息少,通用性好,计算方便快速。
1.轨迹规划
六自由度平台机构由6个并联设置的伺服液压缸驱动,动感平台的任何一个
自由度的运动均会造成6个液压缸的不同运动,所以六自由度平台机构是一个多
变量、强耦合的液压伺服系统,各伺服液压缸需要协调一致地动作,机构在运动
过程中才不至于产生不稳定和破坏现象。对于六自由度平台来说,保持某种姿态
或实现某种运动实际上是使六自由度平台的六根伺服液压缸跟踪期望轨迹的控制
问题。平台要保持某种姿态或达到什么位置,就必须对其运动轨迹进行规划,因
六自由度运动平台方案设计报告doc
1概述
YYPT原理样机用原库房留存的345厂的直流电机作为动力源,直流驱动器及工控机作为控制系统元件,采用VB软件进行控制软件的编制,因设计及器件选型的原因,导致YYPT原理样机,在速度、精度、运动规律上等几个技术指标无法满足原规定的指标要求,现在此基础上进行优化方案的设计。
2 原理样机技术状态
2.1 原理样机方案
2.1.1 组成
原理样机采用工控机作为系统的控制单元,工控机内配有研华PCI1716和PCI1723作为A/D和D/A模拟量卡,驱动器采用AMC公司的型号为12A8的伺服驱动器,并配有直流可调电源其输出电流可达到150A,采用KH08XX(3)电动缸作为运动平台的六条支腿,电动缸上安装有电阻尺作为位置反馈器件,上平台与电动缸连接采用球笼联轴器,下平台与电动缸连接采用虎克铰链方式。具体产品组成表见表2.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 ²,重量5kg 。
基于NI实时控制器的六自由度平台测控系统设计与实现
基于NI实时控制器的六自由度平台测控系统设计与实现王效亮;张芳;曾宪科;栾婷;陈成峰
【摘要】六自由度平台测控系统是六自由度平台的电气控制部分,它通过对六路液压缸的实时闭环控制,实现对平台位姿的控制;该测控系统采用NI的计算机,配置多种类型的PXI板卡,实现了对平台的电压、电流、数字IO、CAN总线等多种接口类型的测量和控制,满足了可靠性需求;采用了典型的上下位机控制,分别进行实时计算与任务管理,解决了实时性的控制需求;采用NI的虚拟仪器Labview开发测控软件,完成实时计算平台的正解与反解模块,作动器闭环控制等功能,增强系统的功能和灵活性;目前六自由度平台测控系统的硬件部分和软件部分都已经通过了调试,对系统进行了正弦运动和暂态特性测试,实验结果表明,运行速度快,满足了平台的控制要求.
【期刊名称】《计算机测量与控制》
【年(卷),期】2019(027)002
【总页数】6页(P24-28,33)
【关键词】六自由度平台;软件;SIT仿真模型
【作者】王效亮;张芳;曾宪科;栾婷;陈成峰
【作者单位】北京精密机电控制设备研究所,北京 100081;北京精密机电控制设备研究所,北京 100081;北京精密机电控制设备研究所,北京 100081;北京精密机电控制设备研究所,北京 100081;北京精密机电控制设备研究所,北京 100081
【正文语种】中文
【中图分类】TP273+.5
0 引言
六自由度平台是一种模拟航天器空间运动姿态的模拟器,在其行程范围内可以模拟任意空间运动。六自由度是平台具有六个自由运动的维度,即纵向、升降、横向、俯仰、横滚、偏航[1]。通过对6个液压作动器的精确控制和解藕算法,实现对平
六自由度运动平台设计方案
六自由度运动平台设计
方案
1概述
YYPT原理样机用原库房留存的345厂的直流电机作为动力源,直流驱动器及工控机作为控制系统元件,采用VB软件进行控制软件的编制,因设计及器件选型的原因,导致YYPT原理样机,在速度、精度、运动规律上等几个技术指标无法满足原规定的指标要求,现在此基础上进行优化方案的设计。
2原理样机技术状态
2.1原理样机方案
2.1.1组成
原理样机采用工控机作为系统的控制单元,工控机内配有研华PCI1716和PCI1723作为A/D和D/A模拟量卡,驱动器采用AMC公司的型号为12A8的伺服驱动器,并配有直流可调电源其输出电流可达到150A,采用KH08XX(3)电动缸作为运动平台的六条支腿,电动缸上安装有电阻尺作为位置反馈器件,上平台与电动缸连接采用球笼联轴器,下平台与电动缸连接采用虎克铰链方式。具体产品组成表见表2.1。
2.1.2结构方案
六自由度运动平台是由六条电动缸通过虎克铰链和球笼万向节联轴器将上、下两个平台连接而成,下平台固定在基础上,借助六条电动缸的伸缩运动,完成上平台在三维空间六个自由度(X,丫,Z,a,B, 丫)的运动,从而可以模拟出各种空间运动姿态。
图1六自由度平台外形图
a)球笼联轴器(如图2所示)
采用球笼铰链与上平面连接。球笼铰链结构简单、体积小、运转灵活、易于维护。
初选球笼铰链型号BJB (JB/T6139-1992),公称转矩Tn=2000N/m,工作角度40度,外径D=68mm,轴孔选用圆柱孔d=24mm,总长度L1=148mm ,转动惯量为
0.00008kg.m2,重量5kg。
六自由度平台样本
滚转角度 偏航角度 最大有效负载
±10弧分 ±10弧分 800kg
±10弧分 ±10弧分 2000kg
±15弧分 ±15弧分 3000kg
±15弧分 ±15弧分 5000kg
±15弧分 ±15弧分 10000kg
±15弧分 ±15弧分 15000kg
±15弧分 ±15弧分 20000kg
以上的参数仅供参考,可以根据客户的实际需求,做相应的非标设计。
±0.45m/s
±300/s ±300/s ±300/s
±1m/s
±300/s ±300/s ±300/s
±1m/s
±300/s ±300/s ±300/s
±1m/s
±300/s ±300/s ±300/s
单自由度最大加速度 垂直方向 纵向方向 侧向方向 俯仰角度 滚转角度 偏航角度
±5.0m/s2 ±5.0m/s2 ±5.0m/s2
上下平台虎克铰接 高精密加工虎克铰接,保证系统的位置精密度和运动平滑无间隙,有限元分析保证虎克铰接及销轴的安全性,维护成本低
上下工作平台 根据客户订制的特殊上下平台,有限元分析保证足够的强度,上平台可以增加旋转平台,增加到7自由度
合肥办事处 电话:0551-7193652
传真:0551-7193651
±0.80m ±250 ±250 ±250
±1m ±250 ±250 ±250
六自由度工业机器人的绝对位置测量及运动学标定技术
汇报人:
日期:
目
CONTENCT
录
• 引言 • 绝对位置测量技术 • 运动学标定技术 • 实验设计与结果分析 • 技术优势与应用场景 • 研究结论与展望
01
引言
研究背景与意义
随着制造业的快速发展,六自由度工业机器人被广泛应用于生产 制造领域。然而,由于机器人运动学模型的复杂性和实际运行环 境的多样性,工业机器人的绝对位置精度往往受到限制,这影响 了制造过程的质量和效率。
首先,收集大量的机器人运动数据,并利用这些数据训练一个神经网络 模型。然后,通过该模型,输入机器人的末端执行器的位置和姿态信息 ,输出机器人各关节角度。
应用场景
常用于解决复杂的非线性问题,提高机器人的适应性和灵活性。
04
实验设计与结果分析
实验设备与环境介绍
设备
六自由度工业机器人(ABB IRB1200)、激光跟踪仪(Leica AT901)、反光 标志点、计算机等。
2. 研究工业机器人的运动学标定方法,通过实验获取 机器人的运动学参数;
研究内容与方法
3. 结合实验数据,对 机器人的运动学模型 进行验证和优化。
1. 理论分析和实验验 证相结合;
本研究采用的方法包 括
研究内容与方法
2. 开发基于激光跟踪仪的测量系统,对工业机器人 进行位姿测量和运动学标定;
六自由度平台
六自由度平台
简介
六自由度平台是一种具有六个自由度的机械装置,用于模
拟某种特定的运动或操作。它由一个固定的基座和一个可运动的平台组成,平台可以在六个方向上进行运动。这些方向分别是平移运动的x、y和z轴以及旋转运动的绕x、y和z轴。
工作原理
六自由度平台的工作原理基于平台上的六个自由度。通过
控制这些自由度的运动,可以实现平台的任意姿态和位置。
六自由度平台通常由六个执行机构组成,每个执行机构负
责控制平台上的一个自由度。这些执行机构可以是液压马达、电动推杆或转动电机等。通过改变这些执行机构的运动方式和速度,可以控制平台的姿态和位置。
在六自由度平台上,平台和基座之间通常有一个连接机构。这个连接机构被设计为可以使平台相对于基座在六个方向上运动,并且能够支持所需的载荷。常见的连接机构包括球接头、万向节等。
六自由度平台在许多领域都有重要的应用。以下是一些典
型的应用领域:
航天航空领域
在航天航空领域,六自由度平台可以用于模拟和测试航天
器和飞行器的运动和操纵。通过控制平台的自由度,可以模拟各种姿态和操纵条件,以帮助设计和验证飞行器的控制系统。
机器人领域
在机器人领域,六自由度平台可以用于模拟和测试机器人
的运动和操作。通过控制平台的自由度,可以模拟各种机器人的运动和操作场景,以帮助设计和验证机器人的运动控制算法。
模拟训练领域
在模拟训练领域,六自由度平台可以用于模拟各种训练场景,如飞行模拟器、驾驶模拟器等。通过控制平台的自由度,可以模拟各种实际场景下的运动和操作,以帮助训练人员提高技能和应对各种情况。
在医疗领域,六自由度平台可以用于模拟和测试医疗设备的运动和操作。通过控制平台的自由度,可以模拟各种医疗设备的运动和操作,以帮助医生和护士熟悉设备的使用和操作步骤。
六自由度振动试验系统运动极限
1 振 动 系统 几 何 模 型
在实 际振 动 环境 中 , 大 部分 产 品有 6个 自由度
等都开 始研究 多 轴振 动 环 境 试 验技 术 , 且 应 用 到实
* 国 家 自然 科 学 基 金 资 助 项 目( 1 0 9 7 2 1 0 4 , 1 1 1 0 2 0 8 3 ) 收稿 E l 期: 2 0 1 I - 1 2 — 2 6 ; 修 改 稿 收到 日期 : 2 0 1 2 — 0 4 — 2 6
表1多轴振动台参数设定mm各振动台参数数值14振动台轴向长度30058振动台轴向长度200振动台轴向位移极限25台面尺寸200200台体高100同向水平振动台之间距离120垂向振动台之间距离120表2各振动台上铰点的坐标向量mm位置a1a2a3a4a5a6a7a8x100100606060606060y606010010060606060z000050505050265振动测试与诊断第33卷表3各振动台下铰点的坐标向量mm位置b1b2b3b4b5b6b7b8xyz400600400600604000604000606025060602506060250606025032计算结果向量aj和向量bi的值分别为aj和bi的坐标值
样 的指标 是试 验能否 成功 的关键 。笔 者根 据斯 图尔 特平 台模 型[ 1 ] 的分 析方 法 , 以六 自由度 电 动振 动
六自由度机械臂毕业设计
六自由度机械臂毕业设计
一、引言
在工业自动化领域,机械臂被广泛应用于各种生产线的加工、组装等操作中。六自由度机械臂是一种具备六个可独立运动自由度的机械臂,可以在三维空间内完成多种复杂的任务。本毕业设计旨在设计和实现一台六自由度机械臂,用于特定的工业应用。
二、设计要求
为了实现设计目标,我们需要满足以下要求: 1. 具备六个独立自由度的运动能力;
2. 机械臂尺寸紧凑,适合在狭小空间内操作;
3. 控制系统稳定可靠,能够精确
控制机械臂运动; 4. 具备良好的安全性,能够保证操作人员的安全; 5. 成本控制合理,能够在实际生产中具备竞争力。
三、设计方案
3.1 机械结构设计
考虑到机械臂需要操作空间较小的环境,我们选择了轻量化的材料,并采用了紧凑的设计。机械臂的臂长和关节长度经过精确计算,确保在给定空间内能够完成所需的运动。
3.2 关节驱动设计
机械臂的每个关节都需要有独立的驱动能力。我们选择了高精度的电机和相应的传动装置,以确保关节运动的精确度和稳定性。
3.3 控制系统设计
为了实现对机械臂的精确控制,我们设计了一个稳定可靠的控制系统。该系统包括传感器用于实时获取机械臂的位置和姿态信息,以及控制器用于计算和控制机械臂的运动。
3.4 安全设计
为了保证操作人员的安全,我们在设计中考虑了多种安全保护措施。例如,添加安全限位开关用于监测和控制机械臂的运动范围;在关节处设计防护罩,以防止意外发生。
四、实施步骤
为了完成六自由度机械臂的设计和制作,我们将按照以下步骤进行: 1. 进行机械结构设计,确定机械臂的尺寸和形状。 2. 选择合适的传动装置和电机,设计关节驱动系统。 3. 设计控制系统,包括传感器和控制器的选型和布置。 4. 进行安全性分析,设计安全保护措施。 5. 制作机械臂的零部件,并进行装配和调试。 6. 进行系统测试和性能评估,确保机械臂满足设计要求。 7. 进行性能优化和改进,解决可能存在的问题。 8. 完成最终的机械臂设计和制作报告。
六自由度振动测试新方法
六自由度振动测试新方法
焦健超;唐力伟;汪伟;杨通强
【摘要】Based on acceleration sensors array, a new method was put forward for 6-DOF test of vibration parameters vising the technology of GFSINS for reference. The object for research was the mechanical system whose complex vibration consisted of linear vibration and angular vibration. This method has solved the problem that was difficult to measure 6-DOF parameters of complex vibration by testing the 3-dimension linear acceleration and angular velocity. On the foundation of deducing the algorithm, the feasibility and veracity of the method were verified by simulating a scheme of nine acceleration sensors array.%提出一种对六自由度振动参数进行测试的新方法,借鉴无陀螺捷联惯导的相关技术,基于加速度传感器按一定位置安装组成的阵列,以发生线振动、角振动耦合的复杂振动的机械系统为研究对象,进行三维线加速度与三维角速度参数测试,有效地解决了复杂振动环境下六自由度参数难于测试的问题.以一种九加速度传感器阵列方案模型为例,在推导原理算法的基础上,通过对该模型的计算机仿真,着重分析了角速度的测试结果,从而验证了本方法是准确可靠的.
六自由度机器人仿真系统设计
六自由度机器人仿真系统设计
肖丽
【摘要】根据机器人的实践教学、技术人员培训和离线运动仿真需求,文章设计了基于VC和OpenGL软件的六自由度机器人仿真系统.建立机器人三维仿真模型,采用VC语言编写了机器人的运动学程序,设计了虚拟机器人的控制界面.在开发的仿
真系统上进行了测试实验,结果表明该系统实现了对机器人三维运动仿真和实时控制,验证了该系统的有效性.
【期刊名称】《无线互联科技》
【年(卷),期】2018(015)018
【总页数】3页(P62-64)
【关键词】机器人;仿真系统;OpenGL;界面设计
【作者】肖丽
【作者单位】郑州轻工业学院,河南郑州 450002
【正文语种】中文
随着机器人技术的快速发展,机器人技术在制造业、物流、服务业、医疗康复、农业等方面获得了广泛应用。据统计,我国需要大量的机器人技术方面的人才。因此,培养机器人设计、操作、维护人员对促进我国机器人产业的快速发展具有重要意义。目前的机器人成本普遍偏高,受各方面条件限制,机器人在国内高校普及较少,机器人教学只是理论教学,无法开展实践教学。国内许多高校开展了机器人仿真系统
的研究,于振中、程智勇等[1-2]基于OpenGL技术开发了工业机器人三维仿真系统。刘振宇等[3]基于OpenGL和Matlab软件开发了机器人在线仿真实验平台。
彭建盛等[4]基于LabVIEW软件开发了智能机器人仿真系统。针对目前实际情况,为满足机器人课程实践及相关培训的要求,设计一种虚拟机器人仿真系统具有重要意义。同时在设计的机器人仿真系统上可以进行运动学建模与仿真,离线编程与运动仿真,可以降低机器人生产成本与提高执行效率[5]。
基于Leap Motion的六自由度机械臂控制系统
一
2
图 1系统 结 构框 图 1 . 1 L e a p Mo t i o n 手 势 传 感设 备 L e a p Mo t i o n 是L e a p 公1 卅生 产 的 一 种 专 门采 集手 部 运 动 信 息 的 传 感 器 , 内 部 主 要 由 颗 红 外 L E D和 两 个 摄 像 头 构 成 。 利 用 视 差 对 进 入 视 野 以 别 区 内 的 目标 立 二 维 影 像 模 型 , 并 实 时 获 取手 势 的 空 间 信 息 。基 于 计 算机 视 觉 的 F势 识 别 算 法 仃 琏 于模 板 匹配 的 算法 、 基 于 神 经 网 络 的 算 法 和 基 于 隐 尔 町 夫模 ’ 的 算法 等 , 由此 得 小 L e a p Mo t i o n 检 测 到 的 手 对象属性表如 捉1 所示 。 表1手对 象属性表
{ + 一 厶 = 丘
{ ( x 3 一 ) : ’ 一 ) = ‘
l 、 其中 :
一
:
√ ;
【
: u ’H t
j l… 一
专
0
上式是欠定方程组, 禽有无穷多组解,若采用解析几何法 ,最终仍需 通 过迭 代 方 式进 行 数 值 计 算 ,因 此 通过 求 极 值 的方 法 来 算 出机 械 臂 在运 动 过程 中哪 种 运动 轨 迹 耗 能 最少 ; 最 后用 求 解 实 例 的方 法 验 汪正 运 动 学模 型 和逆 运 动 学 求解 的 正确 性 。此 时 各 关节 旋 转 角度 可得 :
基于六自由度机器人的航天服性能参数测试
passive robof and mo订“g sp∞e 0f theⅣA印acesu“are analysed ExPedmen叫resuJt8 p‘0ve the effective— ness of the measⅡ五“g pdnciple, so功e other potential叩plication8 of the me酷ud“g system are also dis.
本文所设计的仿生式控制体系结构全面吸收和借 鉴了慎思式智能、反应式智能和分布式智能的优点与 长处,生命的本质特征为基础设计适用于第四代仿生 机器人的仿生式体系结构,实现了仿生机器人单代问 的学习和多代问的进化,对机器人的发展有着重要的 意义和影响。
[参考文献] [1]AlbIl自』s,H&Meca虹R.LuⅢ讧NAsA,瑚s slaTld日Id Ref缸nce
Modd如rTd尉obmconⅡol syskmAmhn酏tum(NAsREM)[A]
NBs Technic日l[s]:1235—1254'1988
0fR幽撕㈣d [2]R0d“ey A Bmok自A Robu8“mye。剖c衄tml syskm Fo'A M0b扯
R0bot[J] IEEE J伽md
将此验证测试装置测量的结果与机器人的测量结 果相比较,对测试系统进行评价。 6测试实验
如图7所示为实际的航天服关节力学测试系统。 其中,工业控制计算机用于传感器数据的采集和关节 阻尼力矩的计算;sGI工作站用于航天服关节位置和阻 尼力矩的实时三维显示。以下是在这一实际的系统平 台上针对某一套舱内航天服所进行的测试实验的结果。
飞机六自由度模型及仿真研究
飞机六自由度模型及仿真研究
一、本文概述
随着航空工业的快速发展和飞行器设计的日益复杂化,对飞机动力学特性的理解和分析变得越来越重要。其中,飞机的六自由度模型是理解和分析飞机动力学特性的基础工具。本文旨在深入探讨飞机六自由度模型的建立过程,以及基于该模型的仿真研究。我们将首先介绍飞机六自由度模型的基本概念和理论框架,然后详细阐述模型的建立过程,包括动力学方程的推导、运动学方程的构建以及控制逻辑的设计。在此基础上,我们将展示如何利用该模型进行仿真研究,包括飞行轨迹的模拟、飞行稳定性的分析以及飞行控制策略的优化等。我们将总结飞机六自由度模型及仿真研究的重要性,并展望未来的研究方向和应用前景。
本文的目标读者包括航空工程领域的学者、工程师以及研究生,希望通过本文的阐述,能够帮助读者更好地理解和掌握飞机六自由度模型及仿真研究的相关知识和技术。我们也希望本文的研究能够对飞行器设计、飞行控制以及飞行安全等领域的发展提供一定的理论支持和实践指导。
二、飞机六自由度模型建立
在飞行动力学中,飞机的运动可以分解为六个自由度:三个沿坐标轴的平动(纵向、横向和垂直)和三个绕坐标轴的转动(滚转、俯仰和偏航)。六自由度模型的建立是飞行仿真研究的基础,它能够全面、准确地描述飞机的空间运动特性。
我们需要定义飞机的坐标系和参考坐标系。通常采用机体坐标系来描述飞机的姿态和运动,而地面坐标系或惯性坐标系则用于描述飞机的位置和速度。在机体坐标系中,飞机的滚转、俯仰和偏航运动可以通过欧拉角来描述。
接下来,根据牛顿第二定律和动量矩定理,建立飞机的运动方程。这些方程包括沿三个坐标轴的平动方程和绕三个坐标轴的转动方程。平动方程描述了飞机的加速度与所受合力的关系,而转动方程则描述了飞机的角加速度与所受合力矩的关系。
并联六自由度运动平台
并联六自由度运动平台
1.概述
并联六自由度运动平台通过六个驱动缸(伺服缸或电动缸)的协调伸缩来实现平台在空间六个自由度的运动,即平台沿x、y、z向的平移和绕x、y、z轴的旋转运动(包括垂直、水平、横向、俯仰、侧倾和旋转六个自由度的运动),以及这些自由度的复合运动。并联六自由度运动平台可用于机器人、飞行模拟器、车辆驾驶模拟器、新型加工机床、及卫星、导弹等飞行器、娱乐业的运动模拟(动感电影摇摆台)、多自由度振动摇摆台的精确运动仿真等。
图0-1:六自由度及其坐标系定义图
我公司通过自行设计、安装调试,并开发控制软件,同时采用进口关键件对并联六自由度运动平台进行研究开发,目前已完成多套六自由度运动平台应用,典型应用有列车风档液压仿真试验台、F1国际赛车运动仿真台、汽车驾驶模拟器、飞机和飞碟运动模拟器、振动谱试验、海浪模拟试验等。
六自由度运动平台的研制,涉及机械、液压、电气、控制、计算机、传感器,空间运动数学模型、实时信号传输处理、图形显示、动态仿真等一系列高科技领域,是液压及控制技术领域的顶级产品。
2.系统组成
2.1液压伺服类
典型的液压式并联六自由度运动平台主要由机械系统、液压系统、控制系统硬件和控制系统软件四部分组成。
机械系统主要包括:承载平台、上下连接铰链、固定座。
液压系统主要包括:泵站系统、伺服阀、驱动器、伺服油缸和阀块管路。
控制系统硬件主要包括:实时处理器、伺服控制单元、信号调理单元、监控单元和泵站控制单元。
控制系统软件包括:实时信号处理单元、实时运算单元、伺服控制和特殊要求处理单元。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
第19卷第4期仪 器 仪 表 学 报V o l.19 №4 1998年8月CH I N ESE JOU RNAL O F SC IEN T IF I C I N STRUM EN T A ug. 1998
六自由度测试系统3
孙长库 周富强 刘 越 叶声华
(天津大学精密测试技术与仪器国家重点实验室 天津 300072)
摘要 本文所描述的测试系统基于激光全息分光技术和激光干涉测长技术,同时测定目标物体六个自由度的偏差。采用激光漂移补偿技术建立了稳定的激光束基准,采用磁光调制技术减小
光强不稳定等因素对滚转角测量精度的影响,实现了多自由度较高精度的准直。实验表明,在激光
光源距靶标1m时,该系统Ρ重复性误差:线位移小于4Λm,角位移小于4″,整个系统结构简单,测
量效率高。
关键词 六自由度误差 全息透镜 磁光调制 干涉测长
1 引 言
目前,在国内外相继研制的多自由度测量系统中,大都采用多激光束进行,在光路中加多个分光元件,将单一激光束分为多束作为测量基准,利用每一束光所带的位移信息,采用和一般准直仪相同的测试原理,来测量出各自由度的偏差〔1,2〕。这种简单的分光方法所分出的光束独立性不好,作为测量基准时,其相对位置精度难以保证,而且多元件的采用使得测试系统的可动部分不易小型化。近年来出现的双目视觉法六自由度测量系统〔3〕,虽然结构简单,但标定复杂,测量精度难以保证。
本文描述一种利用全息透镜分光和干涉计量的方法,结合激光漂移补偿技术和磁光调制技术同时探测空间物体六自由度偏差,并能保证各被测参数之间的相对独立,实现对空间物体位置精度的动态检测。
2 基本测试原理
测试系统结构示意如图1所示,坐标原点确定为全息透镜的中心O。一准直扩束光束经分光镜分为两束,一束进入干涉系统,被用来测量物体沿Z轴位移。另一束经磁光调制器后入射到全息透镜,被分为三路:非衍射光束2、会聚光束3和发射光束4,利用这三束光所携带的信息来测量其它五个自由度偏差。
当准直光束中心线以方向角Α、Β、Χ入射到全息透镜的中心时,在菲涅尔近似条件下(Α≈Β3 本文于1996年10月收到。
图1 测试系统原理示意图
≈90°,Χ≈0),且只考虑光束所带位置信息,略去时间因子exp (j Ξt ),则通过全息透镜后的透射光波可表示为:
E T =C (A 2+B 2)D exp [jk (xco s Α+yco s Β+zco s Χ)]+ABCD exp [-jk (x 2+y 2-2xx
F 2F
-xco s Α-yco s Β-zco s Χ)]+ABCD exp [jk (x 2+y 2-2xx F 2F
+xco s Α+yco s Β+zco s Χ)](1)其中A 为参考光振幅;B 为物光光波的振幅;C 是全息透镜透射系数;D 是照明光波振幅;F =x F 2+z F 2为全息透镜的焦距;co s Α、co s Β、co s Χ是照明光波的方向余弦。式中第一项为照明光束的继续,可视为原路光束,它被一位置敏感探测器(PSD )接收,其作用同一般激光准直仪一样,可实现光靶与激光束在X 向及Y 向相对位移的测量。第二项完整地保存了原物光的信息,若为会聚光束,则该光束沿任何方向平移或绕Z 轴相对转动,都不改变全息透镜焦点的相对位置,仅当它与光靶之间有绕X 轴或Y 轴的相对转动时焦点才会移动。因此该光束在焦点处被另一PSD 接收,便可实现Ηx 、Ηy 的测量
。第三项也保存了原物光的信息,但它与原物光在位相上是共轭的,第二项为会聚光束,则它应该为发散光束,我们将利用它与照相光束具有相同偏振特性的特点实现ΗZ 的测量
。211 沿Z 轴方向相对位移∃Z 的测量
采用激光干涉测长的原理,将测量光路中的可动角锥棱镜固定在测量靶标上,靶标置于被测物体上,和一般干涉仪一样,通过读干涉条纹来测定位移。为提高测量精度,采用移相系统,将干涉条纹分成位相彼此相对移动Π 2的两部分,并把这两部分干涉条纹分别送到两个光电探测器(P I N )上。两光电探测器输出的电信号彼此也有Π
2的位相差,这两路电信号经整形放大及倒相,变成四个矩形脉冲信号,经微分后,得到四个依次相差Π 2的脉冲,对四个脉冲采用可逆计数,得到四倍频脉冲数N ′,于是Z 轴向相对位移由下式求得:∃z =N ′Κ
8(2)212 偏摆角Ηx 、俯仰角Ηy 及沿轴X 、Y 向相对位移∃x ,∃y 的测量
当Α≈Β≈90°,Χ≈0时,所检测各自由度偏差非常小,建立如图2所示的坐标系。易推原路光束及会聚光束在两个PSD 上的坐标B (x B ,y B )、B 1(u B 1,v B 1)和照明光束位置信息∃x 、∃y 、Η
x 、Ηy 的近似关系:
∃x ≈x B
∃y ≈y B (3)
3
63 第4期六自由度测试系统
图2 基准激光束与系统坐标系Ηx
≈u B 1 x F 2+Z F 2Ηy
≈v B 1 z F (4)
213 磁光调制测量滚转角ΗZ 基于法拉弟旋光效应〔4〕:
Η=V HL (5)其中Η是线偏光旋光角;V 、L 为光学玻璃的旋光系数和几何长度;H 是磁场强度。
激光器发出的一束线偏振光,入射到检偏器时,根据马吕斯定律,出射光强可表示为:I out =I 0co s 2Η。Η为光束偏振方向和检偏器光轴的夹角。当光束偏振方向与检偏器光轴正交时,Η可
用下式表达: Η
=90°+ΗZ +A sin Ξt (6)其中:ΗZ 是滚转角;A 是调制幅度;Ξ是调制频率,于是
I out =I 0co s 2(90°+ΗZ +A sin Ξt )
=12
I 0[1-co s 2ΗZ co s (2A sin Ξt )-sin 2ΗZ sin (2ΗZ sin Ξt )]=C -co s 2ΗZ 6∞k=1J 2k (2A )co s (2k Ξt )+sin 2ΗZ 6∞
k=0J 2k+1(2A )sin [(2k +1)Ξt ](7)
式中:C =12
I 0[1-J 0(2A )co s 2ΗZ ]为直流分量,各项贝塞尔函数J k (2A )的值随k 的增大急剧减小,且只有基波信号才包含我们所关心的滚转角信息,因此滤去直流分量及所有高频信号,光强信号可以表示为:
I out =sin (2ΗZ )J 1(2A )sin Ξt -co s (2ΗZ )J 2(2A )co s 2Ξt (8)
当ΗZ =0时,即光束偏振方向和检偏器光轴处于正交时,系统工作在极小位置,接收到的信号为调制频率的二倍频信号。当系统偏离极小位置时,随着ΗZ 的增大,二倍频信号减弱,基频信号增加,并根据基频信号的相位来进行辨向。利用锁相放大器对输出信号进行相敏整流和积分运算,其输出的直流电压与滚转角大小成比例,根据所测得的直流电压就可以得到滚转角信息。
214 激光漂移补偿器
该测试系统在测量Ηx 、Ηy 及沿轴X 、Y 向相对位移时,是以激光束的能量中心为测量基准,其测量精度主要取决于激光束的空间稳定性。但因激光器谐振腔热变形引起光束偏离理想基准方向,影响激光准直精度,所以在该系统中加入漂移补偿器,以建立稳定的测量基准。
该系统采用一个复合棱镜组,获得稳定的能量中心。当一束光入射到补偿器后,出射光是由两束能量相等在空间完全对称的光束合成的,当入射光束有漂移时,其两束出射光的合成能量中心仍保持不变。
3 测试实验结果
按前文所述原理,在实验室设计了基本测试系统,将测量靶标固定在六自由度工作台上,采用双频激光干涉仪对滚转角进行了标定,并在靶标距光源1m 时对各参数在不同时间对给定位置进行多次实验,获得了系统的重复性误差。实验表明,线位移重复性误差在Ρ范围内优
于4Λm ,角位移优于4″。
同时,我们采用该系统和双频激光干涉仪对滚转角进行了比对实验,结463仪 器 仪 表 学 报 第19卷