实验一：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个液压缸作为驱动关节，每个液压缸两端各连接一个球铰。
六个驱动关节的伸缩运动是独立的由液压比例压力阀控制各液压缸作伸缩运动，从而改变各个驱动缸的长度，使动平台在空间的位置和姿态发生变化。
因此该平台是通过六个驱动杆的协调动作来实现三个线性移动及三个转动共六个自由度的运动。
S tewart平台机构的空间位置关系是指运动平台的六个自由度与六个驱动杆长度的关系，是研究该并联机构最基本的任务，也是机构速度、加速度、误差分析、工作空间分析、动力分析等的基础。
对于6-SPS平台机构，其特点是动静平台铰点共面，考虑到工作空间的对称性要求，将平台的6个铰点分成3组，三组铰点沿圆周120。
均布，动、静平台的相邻两边到中心的夹角分别为30。
和90° o为求解六自由度平台的空间位置关系，首先在静、动平台上分别建立静、动坐标系。
如图3.3所示，静坐标系XYZ原点0位于静平台的中心，X-Y平面与下平台上各液压缸铰接点分布圆共面,动坐标系X YZ的原点0位于平台上平台中心，当上平面位于中位时，动、静坐标系的Z和Z轴重合，且静坐标系Z 轴穿过0 '。
以第i 只液压缸为例描述该机构的空间位置关系 。
设P为从动坐标系原点 标。
可利用动平台的位姿(X, y,乙 W 「y,?z)及各铰接点在动平台上的位置，进 行坐标变换，求得各铰接点在静坐标系中的坐标。
在动坐标系中的任一向量 P i可以通过坐标变换方法变换为固定坐标系中的r i0'至平台铰接点Pi 的矢量在静坐标系的表示，P = (R x , R y , R z )P mi=(R mix,R miy,R niz)为0'点至Pi 的矢量在动坐标系的表示B i为从点到Bi点的矢量在 静坐标系的表示，B =(B x ,B iy ,B z )TR 为在静坐标系中从点到点0'的矢量， R 二(x,y,z)T 。
r为在静坐标T系中从0点到Pi 点的矢量，r= (r ix, r iy, r iz)，也是Pi 点在静坐标系中的坐标。
h 为静坐标系 中从B i至R的矢量，h=(lix，h y ，l iz)T ，各矢量间的关系如图3所示。
以静坐标系为参考坐标系， 得到六自由度平台中各位置相互关系的矢量关系式 ：尸P+ Rri = B i l id.i )l i- B i = P iR B i(1.2)位置逆解是由动平台的位姿(x,y, z,• x,• y,• z )相对于其在中位时的中心位前已经很成熟，能够用于实际系统的实时计算位置逆解的求解，关键是要求出动平台上各关节铰接点在静坐标系中的坐 图3.3空间矢量关系示意图化简得到平台位姿与各驱动关节杆长矢量的关系式置(x ，y ，z )及角姿态 mu 求解各液压缸的伸缩量，位置逆解的精确算法目r i二TR R其中：变换矩阵T :式中:C?x 二cos(?x),S?x =sin(?x)当给定平台的结构尺寸后，利用几何关系，可以很容易写出动、静平台各铰接点(P i，B i, i=1,2, ,6)…在各自坐标系中的坐标值，再由式(1.3)求出动平台各铰点在静坐标系中的坐标值。
这时6个驱动器杆长矢量l i(i = 1,2，…,6)可在固定坐标系中表示为：l i - I] ■ B j - T P i R ■ B i从而得到并联机构的位置反解计算公式：i i =ih I=」2+I；+i iZ液压缸i的伸缩量Si为：S 屮i ITh I neut其中|li|neut为驱动杆i的中位长度，i=1,…,6上式是6个独立的显式方程，当已知该并联机构的基本尺寸和动平台的位(1.3)C7z C7y T =T x T Y T z = S 普z C 甲y-S甲y1 0 0T x = 0 C甲x卞巒x0 S霞C普x jC?z S?y S?x —S?z C?xS?z S?x Sy y CV z C 宇xCVySVx_ C甲y 0 S普y ]T Y = I 0 1 0-S普y 0 C普y_c?a x sy y s?z s?xS普z C甲x S普y — C甲z时xC甲y C甲x一C?z -S f z 0T资c甲0(1.4)(1.6)置和姿势后，就可以求出6个驱动杆的杆长。
这就是六自由度平台的逆解。
四、试验内容1.根据六自由度平台系统原理图和相关电气元器件接线说明设计电控系统的电气原理图详见附件六自由度电气原理图.dwg ”；2.了解影片动作文件的编辑，熟练操作六自由度影片播放软件；3.熟练操作六自由度平台调试软件；五、六自由度调试软件界面介绍1.六自由度调试界面”界面介绍打开软件，弹出六自由度操作界面”，界面上左边一列为六个自由度的姿态和角速度的设置值，界面如图1:设计好、线速度设置值显示：显示的是当前平台设置值是多少设置值：填写需要设置的值是多少设置 设置值”：分别点击这8个按钮可以将界面上对应的一个参数设置到 参数全写入：点击将8个参数一同设置到 PLC 中「显示僖卅由值:norr nn¥轴值*000 00m m 込轴值;000 m m单位a 夹角1倩：■V夹吊值;线速度值:角速度值:000 000000 000 00000 00 0040養数全取界面正上方显示的是液压站电机和溢流阀的工作状态 ，绿色表示电机打开和溢流阀加PLC 中。
压工作，如图2显示指示灯油泵工作加压显示图2位移传感器报警如图 3显示，红色表示报警，共12个报警显示的是六根油缸的上下限 位极限报警位移倍感器振饗炜缸位移传愍器低位报警 饌缸位移传感器阳立报警 加缸位移传感器低位掙警 心缸位移传感器低位报警 强缸位移传感器低位报警 帥缸位移传感器低位报警 律缸位移传愍器高位报警 義缸位移传感器高位报書 黑缸位移传感器高位报警 据缸位移传感器髙位报警 州缸位移传感器高位报警 6#缸位移传愿器高位报警图3计算值显示位于油温油压显示的下方 ，如图4所示，显示的是经过平台逆解，六根油缸的伸缩值，也是六根油缸的位移设置值，图4位移显示位于软件界面的右下方，如图5所示，显示的是六根油缸当前的位移值图5控制按钮位于软件下方，如图6显示，电机可以控制液压站电机启动、停止，还可以控制平台上升到中位和下降到最低位点击软件下方的 地震模拟”按钮就会关闭 六自由度操作界面”，同时打开 模拟画面”界 面。
电机软件下方的 退出画面”按钮就可以退出本软件。
2. 模拟画面”界面介绍 点击六自由度操作界面”界面下方的地震模拟”按钮就会关闭六自由度操作界面”，同 时打开模拟画面”界面。
在 模拟画面”界面上有平台六个自由度的初幅值 、幅值和频率的设置界面，如图7所平台以中位为平台六个姿态 上下平移”、前后平移”、左右平移”、侧翻运动”、俯仰图6丄下申弊初恆但|〒曲 懾值|13。
nm硕率| °去HZ初搐值|~5~ 3幅追| 20.0 度 频率|0 SH E 初幅值 r ，mm幅值 200mm频率 C. 5 Ha::；拓诩运訪二初幅值―E — 5 ]幅值|如。
度 频率 匸丁H E初幅值| °幅值| 200频率| °・5ro nn Hz::总菠龙也■:初幅值|~5~ 5 r 20 0 ® 频率Hz运动”和扭转运动”的零位，即平台上升到中位时这六个姿态值为应该设置为零。
平台的初幅值就是以中位为基准设定的。
初幅值：平台以初幅值为中间位置往返运动幅值：平台往返运动的幅度注：初幅值和幅值的设置范围可以参考文档六自由度地址表.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”，界面如下图所示；六自由度操作界面呆起1円4童「000| 000哪刘|宓\ 000百弭片值| 00C| 000r.|祁【啊「6oo 1 000r ooo| 000WUIK#| 000| 000• •amnC也#傅星■帧窘4*抚位甘住恿却』•洋g口£1位祿漫惑撤'U抵聲謁口亦訂辺船诃榊芒ME磁详苦烹西二训E :泵辱I牡IdCc）根据第五步中对该软件界面的介绍，设置相应的参数，平台就会依照设置值动作；试验结束后，退回到六自由度操作界面”，一次点击平台归位”按钮，待平台运动到最低位后，点击泵停”按钮，关闭点击并泄压，结束试验。