实验指导书六自由度.docx
《实验指导书六自由度.docx》由会员分享，可在线阅读，更多相关《实验指导书六自由度.docx（14页珍藏版）》请在冰点文库上搜索。
实验指导书六自由度
实验一：
6SPT-1六自由度液压伺服平台综合实验
、实验目的：
1、掌握电液位置伺服控制系统的基本原理；
2、掌握六自由度平台的结构解算的概念及其软件实现；
3、掌握VB6.0软件与下位机PAC通过以太网通信的方法；
4、掌握6SPT-1六自由度液压伺服平台复现指令信号的实施方法。
、预备知识：
1、熟练掌握PLC的梯形图语言（LD）编程和结构化文本语言（ST）编
程；
2、熟练掌握VB6.0编程，能使用VB6.0实现以太网通信；
3、有一定的矩阵计算能力。
二、试验原理：
1、电液位置伺服控制系统的基本原理
电液位置伺服控制系统以液体作为动力传输和控制介质，利用电信号进行
控制输入和反馈。
只要输入某一规律的输入信号，执行元件就能启动、快速并
准确地复现输入量的变化规律。
控制系统结构图如图3.1所示:
图3.1电液位置伺服控制系统结构图
2、六自由度平台逆解算法
图3.2空间机构位置关系示意图
六自由度平台又称为Stewart平台，其结构如图3.2所示，Stewart平台由上、下两个平台、六个驱动关节和连接球铰组成，上平台为运动平台，下平台为基座，上、下平台的六个铰点分别组成一个六边形，连接6个液压缸作为驱动关节，每个液压缸两端各连接一个球铰。
六个驱动关节的伸缩运动是独立的由液压比例压力阀控制各液压缸作伸缩运动，从而改变各个驱动缸的长度，使
动平台在空间的位置和姿态发生变化。
因此该平台是通过六个驱动杆的协调动
作来实现三个线性移动及三个转动共六个自由度的运动。
Stewart平台机构的空间位置关系是指运动平台的六个自由度与六个驱动杆长度的关系，是研究该并联机构最基本的任务，也是机构速度、加速度、误差分析、工作空间分析、动力分析等的基础。
对于6-SPS平台机构，其特点是动静平台铰点共面，考虑到工作空间的对称性要求，将平台的6个铰点分成3组，三组铰点沿圆周120。
均布，动、静平台的相邻两边到中心的夹角分别为30。
和90°o
为求解六自由度平台的空间位置关系，首先在静、动平台上分别建立静、动坐标系。
如图3.3所示，静坐标系XYZ原点0位于静平台的中心，X-Y平面
与下平台上各液压缸铰接点分布圆共面,动坐标系XYZ的原点0位于平台上平台中心，当上平面位于中位时，动、静坐标系的Z和Z轴重合，且静坐标系Z轴穿过0'。
以第i只液压缸为例描述该机构的空间位置关系。
设P为从动坐标系原点标。
可利用动平台的位姿（X,y,乙W「y,?
z）及各铰接点在动平台上的位置，进行坐标变换，求得各铰接点在静坐标系中的坐标。
li-Bi=PiRBi
（1.2）
位置逆解是由动平台的位姿
（x,y,z,•x,•y,•z）相对于其在中位时的中心位
化简得到平台位姿与各驱动关节杆长矢量的关系式：
置（x，y，z）及角姿态mu求解各液压缸的伸缩量，位置逆解的精确算法目
前已经很成熟，能够用于实际系统的实时计算
位置逆解的求解，关键是要求出动平台上各关节铰接点在静坐标系中的坐
在动坐标系中的任一向量Pi可以通过坐标变换方法变换为固定坐标系中的
ri
（1.3）
ri二TRR
其中：
变换矩阵T:
（1.4）
（1.6）
式中:
C?
x二cos（?
x）,S?
x=sin（?
x）
当给定平台的结构尺寸后，利用几何关系，可以很容易写出动、静平台各铰接点（Pi，Bi,i=1,2,,6）…在各自坐标系中的坐标值，再由式（1.3）求出动平台各铰点在静坐标系中的坐标值。
这时6个驱动器杆长矢量li（i=1,2，…,6）可在固定坐标系中表示为：
li-I]■Bj-TPiR■Bi
从而得到并联机构的位置反解计算公式：
ii=ihi=」2+i；+iiZ
液压缸i的伸缩量Si为：
S屮iIThIneut
其中|li|neut为驱动杆i的中位长度，i=1,…,6
上式是6个独立的显式方程，当已知该并联机构的基本尺寸和动平台的位
置和姿势后，就可以求出6个驱动杆的杆长。
这就是六自由度平台的逆解。
四、试验内容
1.根据六自由度平台系统原理图和相关电气元器件接线说明设计电控系统
的电气原理图详见附件六自由度电气原理图.dwg”；
2.了解影片动作文件的编辑，熟练操作六自由度影片播放软件；
3.熟练操作六自由度平台调试软件；
五、六自由度调试软件界面介绍
1.六自由度调试界面”界面介绍
打开软件，弹出六自由度操作界面”，界面上左边一列为六个自由度的姿态
设计好
、线速度
和角速度的设置值，界面如图1:
「显示僖
卅由值:
no
rrnn
¥轴值*
000
00
mm
込轴值;
000
mm
单位
a夹角1倩：
■V夹吊值;
线速度值:
角速度值:
000
000
000
000
000
00
00
00
40
養数全取
设置值显示：
显示的是当前平台设置值是多少
设置值：
填写需要设置的值是多少
PLC中。
设置设置值”：
分别点击这8个按钮可以将界面上对应的一个参数设置到
参数全写入：
点击将8个参数一同设置到PLC中
界面正上方显示的是液压站电机和溢流阀的工作状态
，绿色表示电机打开和溢流阀加
压工作，如图2显示
指示灯
油泵工作加压显示
图2
位移传感器报警如图3显示，红色表示报警，共12个报警显示的是六根油缸的上下限位极限报警
位移倍感器振饗
炜缸位移传愍器低位报警饌缸位移传感器阳立报警加缸位移传感器低位掙警心缸位移传感器低位报警强缸位移传感器低位报警帥缸位移传感器低位报警律缸位移传愍器高位报警義缸位移传感器高位报書黑缸位移传感器高位报警据缸位移传感器髙位报警州缸位移传感器高位报警6#缸位移传愿器高位报警
图3
计算值显示位于油温油压显示的下方，如图4所示，显示的是经过平台逆解，六根油
缸的伸缩值，也是六根油缸的位移设置值，
图4
位移显示位于软件界面的右下方，如图5所示，显示的是六根油缸当前的位移值
图5
控制按钮位于软件下方，如图6显示，电机可以控制液压站电机启动、停止，还可以
控制平台上升到中位和下降到最低位
图6
点击软件下方的地震模拟”按钮就会关闭六自由度操作界面”，同时打开模拟画面”界面。
电机软件下方的退出画面”按钮就可以退出本软件。
2.模拟画面”界面介绍点击六自由度操作界面”界面下方的地震模拟”按钮就会关闭六自由度操作界面”，同时打开模拟画面”界面。
在模拟画面”界面上有平台六个自由度的初幅值、幅值和频率的设置界面，如图7所
平台以中位为平台六个姿态上下平移”、前后平移”、左右平移”、侧翻运动”、俯仰
运动”和扭转运动”的零位，即平台上升到中位时这六个姿态值为应该设置为零。
平台
的初幅值就是以中位为基准设定的。
初幅值：
平台以初幅值为中间位置往返运动
幅值：
平台往返运动的幅度
注：
初幅值和幅值的设置范围可以参考文档六自由度地址表.xlsx”中的相关姿态的设
置范围。
频率：
平台往返运动的频率
注：
这三个值的设置范围可以参考文档六自由度地址表.xlsx”中的相关姿态的设置范
围。
举例：
设置上下平移”的初幅值为10，幅值为100，频率为0.5，其他值均设置为0，震动模式选择选中上下震动”，其他不选，点击开启”按钮，则平台将会在110至-90之间（中间值是10，幅值是100）做频率为0.5的往返运动。
震动模式选择如图8所示
厂tF脣动厂前后^讓一左右扭摆厂闸韶运讷厂俯仰运动厂州带匡讪
图8
选中相应的模式，则平台以图7中对应的设置值开始运动，可以同时选中多个模式使
平台两个或两个以上自由度复合运动，但幅值不宜过大，避免超出平台的运动范围。
界面下方有4个操作按钮，如图9所示
关闭
调试画面
开启：
点击开启按钮则平台从中位开始按照图7的设置值和图8选中的模式开始往返
运动
关闭：
平台从当前位置回到最低位
调试画面：
关闭当前界面，打开六自由度操作界面
退出画面：
退出本软件
六、试验步骤
1.六自由度平台影片播放
a）检查电源是否已经安全接入电控操作台，检查液压油箱中液压油是否足
够，检查液压系统是否有漏油、渗油情况，确认后进入下一步；
b）打开软件平台动作软件.exe”，界面下图所示；
c）点击界面上开泵”按钮，启动液压站电机，等待约5秒后系统加压；
d）然后点击平台数据路径选择”按钮选择平台所要播放的动作文件；
e）点击影片选择”按钮选择平台所要播放的影音文件；
f）按下键盘上的Q”键，影片开始播放，平台开始跟随影片动作；
g）影片播放结束时，平台会自动慢慢回到最低位；
h）影片播放过程中，按下键盘上的0”键，影片停止播放，平台停止动作并慢慢回到最低位；
i）结束影片播放后，按下界面上的关泵”按钮，关闭液压站电机并泄压。
2.六自由度平台调试软件操作
a）检查电源是否已经安全接入电控操作台，检查液压油箱中液压油是否足够，检查液压系统是否有漏油、渗油情况，确认后进入下一步；
b）打开软件六自由度.exe”，界面如下图所示；
六自由度操作界面
c）根据第五步中对该软件界面的介绍，设置相应的参数，平台就会依照设
置值动作；
试验结束后，退回到六自由度操作界面”，一次点击平台归位”按钮，待平台运
动到最低位后，点击泵停”按钮，关闭点击并泄压，结束试验。
……
d）
升级会员 