实验指导书(六自由度)

实验一：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°。为求解六自由度平台的空间位置关系，首先在静、动平台上分别建立静、动坐标系。如图3.3所示，静坐标系XYZ原点O位于静平台的中心，X-Y平面与下平台上各液压缸铰接点分布圆共面，动坐标系X′Y′Z′的原点O′位于平台上平台中心，当上平面位于中位时，动﹑静坐标系的Z′和Z轴重合，且静坐标系Z轴穿过O′。以第i只液压缸为例描述该机构的空间位置关系。设iP为从动坐标系原点'O至平台铰接点Pi的矢量在静坐标系的表示，(,,)TiixiyizPPPP。(,,)TmimixmiymizPPPP为'O点至Pi的矢量在动坐标系的表示。iB为从O点到Bi点的矢量在静坐标系的表示，(,,)TiixiyizBBBB。R为在静坐标系中从点O到点'O的矢量，(,,)TxyzR。ir为在静坐标系中从O点到Pi点的矢量，(,,)Tiixiyizrrrr，也是Pi点在静坐标系中的坐标。il为静坐标系中从iB至iP的矢量，(,,)Tiixiyizllll，各矢量间的关系如图3所示。以静坐标系为参考坐标系，得到六自由度平台中各位置相互关系的矢量关系式：iiiiirPRrBl（1.1）化简得到平台位姿与各驱动关节杆长矢量的关系式：iiiiilrBPRB（1.2）位置逆解是由动平台的位姿(,,,,,)xyzxyz相对于其在中位时的中心位XYZO'OiPiBRiliriBiP图3.3空间矢量关系示意图置(,,)xyz及角姿态,,)xyz求解各液压缸的伸缩量，位置逆解的精确算法目前已经很成熟，能够用于实际系统的实时计算。位置逆解的求解，关键是要求出动平台上各关节铰接点在静坐标系中的坐标。可利用动平台的位姿(,,,,,)xyzxyz及各铰接点在动平台上的位置，进行坐标变换，求得各铰接点在静坐标系中的坐标。在动坐标系中的任一向量iP可以通过坐标变换方法变换为固定坐标系中的ir：iiTrPR(1.3)其中：变换矩阵T：zyzyxzxzxyzxXYZzyzxyzxzxyzxyyxyxCCCSSSCCCSSSSCSSSCCSCSCSSCSCCTTTT10000XxxxxCSSCT，00100yyYyyCSSCT，00001zzZzzCSSCT式中：cos(),sin()xxxxCS。当给定平台的结构尺寸后，利用几何关系，可以很容易写出动、静平台各铰接点（iP，iB，i=1,2,…,6）在各自坐标系中的坐标值，再由式(1.3)求出动平台各铰点在静坐标系中的坐标值。这时6个驱动器杆长矢量il（i＝1,2,…,6）可在固定坐标系中表示为：iiiiiTlrBPRBi＝1,2,…,6(1.4)从而得到并联机构的位置反解计算公式：222iixiyizll+l+li=|l|=(1.5)液压缸i的伸缩量Si为：||||iineutSill(1.6)其中|il|neut为驱动杆i的中位长度，i=1,…,6。上式是6个独立的显式方程，当已知该并联机构的基本尺寸和动平台的位置和姿势后，就可以求出6个驱动杆的杆长。这就是六自由度平台的逆解。四、试验内容1.根据六自由度平台系统原理图和相关电气元器件接线说明设计电控系统，设计好的电气原理图详见附件“六自由度电气原理图.dwg”；2.了解影片动作文件的编辑，熟练操作六自由度影片播放软件；3.熟练操作六自由度平台调试软件；五、六自由度调试软件界面介绍1.“六自由度调试界面”界面介绍打开软件，弹出“六自由度操作界面”，界面上左边一列为六个自由度的姿态、线速度和角速度的设置值，界面如图1：图1设置值显示：显示的是当前平台设置值是多少设置值：填写需要设置的值是多少设置“设置值”：分别点击这8个按钮可以将界面上对应的一个参数设置到PLC中。参数全写入：点击将8个参数一同设置到PLC中界面正上方显示的是液压站电机和溢流阀的工作状态，绿色表示电机打开和溢流阀加压工作，如图2显示图2位移传感器报警如图3显示，红色表示报警，共12个报警显示的是六根油缸的上下限位极限报警图3计算值显示位于油温油压显示的下方，如图4所示，显示的是经过平台逆解，六根油缸的伸缩值，也是六根油缸的位移设置值，图4位移显示位于软件界面的右下方，如图5所示，显示的是六根油缸当前的位移值图5控制按钮位于软件下方，如图6显示，电机可以控制液压站电机启动、停止，还可以控制平台上升到中位和下降到最低位。图6点击软件下方的“地震模拟”按钮就会关闭“六自由度操作界面”，同时打开“模拟画面”界面。电机软件下方的“退出画面”按钮就可以退出本软件。2.“模拟画面”界面介绍点击“六自由度操作界面”界面下方的“地震模拟”按钮就会关闭“六自由度操作界面”，同时打开“模拟画面”界面。在“模拟画面”界面上有平台六个自由度的初幅值、幅值和频率的设置界面，如图7所示图7平台以中位为平台六个姿态“上下平移”、“前后平移”、“左右平移”、“侧翻运动”、“俯仰运动”和“扭转运动”的零位，即平台上升到中位时这六个姿态值为应该设置为零。平台的初幅值就是以中位为基准设定的。初幅值：平台以初幅值为中间位置往返运动幅值：平台往返运动的幅度注：初幅值和幅值的设置范围可以参考文档“六自由度地址表.xlsx”中的相关姿态的设置范围。频率：平台往返运动的频率注：这三个值的设置范围可以参考文档“六自由度地址表.xlsx”中的相关姿态的设置范围。举例：设置“上下平移”的初幅值为10，幅值为100，频率为0.5，其他值均设置为0，震动模式选择选中“上下震动”，其他不选，点击“开启”按钮，则平台将会在110至-90之间（中间值是10，幅值是100）做频率为0.5的往返运动。震动模式选择如图8所示图8选中相应的模式，则平台以图7中对应的设置值开始运动，可以同时选中多个模式使平台两个或两个以上自由度复合运动，但幅值不宜过大，避免超出平台的运动范围。界面下方有4个操作按钮，如图9所示图9开启：点击开启按钮则平台从中位开始按照图7的设置值和图8选中的模式开始往返运动关闭：平台从当前位置回到最低位调试画面:关闭当前界面，打开“六自由度操作界面”。退出画面：退出本软件六、试验步骤1.六自由度平台影片播放a)检查电源是否已经安全接入电控操作台，检查液压油箱中液压油是否足够，检查液压系统是否有漏油、渗油情况，确认后进入下一步；b)打开软件“平台动作软件.exe”，界面下图所示；c)点击界面上“开泵”按钮，启动液压站电机，等待约5秒后系统加压；d)然后点击“平台数据路径选择”按钮选择平台所要播放的动作文件；e)点击“影片选择”按钮选择平台所要播放的影音文件；f)按下键盘上的“Q”键，影片开始播放，平台开始跟随影片动作；g)影片播放结束时，平台会自动慢慢回到最低位；h)影片播放过程中，按下键盘上的“0”键，影片停止播放，平台停止动作并慢慢回到最低位；i)结束影片播放后，按下界面上的“关泵”按钮，关闭液压站电机并泄压。2.六自由度平台调试软件操作a)检查电源是否已经安全接入电控操作台，检查液压油箱中液压油是否足够，检查液压系统是否有漏油、渗油情况，确认后进入下一步；b)打开软件“六自由度.exe”，界面如下图所示；c)根据第五步中对该软件界面的介绍，设置相应的参数，平台就会依照设置值动作；d)试验结束后，退回到“六自由度操作界面”，一次点击“平台归位”按钮，待平台运动到最低位后，点击“泵停”按钮，关闭点击并泄压，结束试验。