高精度平台运动系统设计

摘要:为实现Stewart平台的高精度运动控制，设计了基于运动学模型的运动控制系统。在工作空间中使用梯形速度曲线进行轨迹规划，通过位置反解得到关节空间中各支腿的规划轨迹，设计位置—速度双环控制器控制支腿跟踪各自轨迹。为抑制外部扰动，提高鲁棒性，使用基于模型辅助线性扩张状态观测器的自抗扰控制器作为速度环控制器。为在保证轨迹跟踪精度的同时，加快系统镇定速度，使用分段积分重置PI控制器作为位置环控制器。将所设计的控制器应用到实际控制系统中，并进行了运动控制实验。实验表明:在所设计控制系统的控制下，平台运行平稳，并能够较快稳定到目标位姿。

关键词:Stewart平台;自抗扰控制;模型辅助线性扩张状态观测器;积分重置

0引言

大型望远镜光路系统通常包括主镜、次镜，为了保证良好的成像质量，需要主镜与次镜的反射面焦点重合，光轴重合。然而由于重力、振动等原因，主镜和次镜之间的位姿往往会发生改变，从而导致望远镜成像质量受到影响，因此需要对主次镜之间的位姿进行精确的调整和校正。由于主镜的尺寸、质量远大于次镜，若对主镜进行调整，其功耗较大，实际工程中往往采用次镜调整机构来调整主次镜之间的相对位姿［1］。

而Stewart平台因其高精度、高刚度的优点，在大型望远镜中作为次镜调整机构被广泛使用［2］。本文所研究的Stewart平台控制系统，作为次镜调整机构，控制任务为控制动平台从当前位姿点运动到目标位姿点，要求运动过程平稳且不超过工作空间，并且能够快速无差的稳定到目标位姿。

1Stewart平台运动学模型及其反解

1．1Stewart平台运动学模型

本文Stewart平台为6—UCU构型，由上平台、下平台及6条支腿构成，其中上平台为动平台，下平台为静平台。上下平台与6条支腿之间通过虎克铰相连，支腿运动机构可简化为移动—转动副，通过控制6条支腿的长度变化，可控制上平台的3个方向的平移和3个方向的旋转。

1．2Stewart平台位置反解

已知上平台和下平台之间的位姿关系，求解对应的各支腿长度，被称为Stewart平台的位置反解(此处位置的含义为广义位置)。位置反解是对Stewart平台进行运动控制的基础［3］。

2工作空间轨迹规划

由于并联平台特殊的闭环运动链构型，其工作空间有限［4］，若让各支腿直接运动到运动学反解计算出的目标位置处，在运动的过程中动平台可能会超出工作空间，因而必须对并联平台进行轨迹规划。考虑动平台从位姿点u1到位姿点u2的轨迹规划，由于所设计控制系统只需实现点位控制，对轨迹形状不做要求，为求简便，取轨迹为6维空间内的一条线段。同时为使运动更加平稳，使用梯形速度曲线对平台运动速度进行规划按平台能否加速到最大速度分为两种情况，

1)能够加速到最大速度时，速度和加速度曲线，0～t1段为加速段，以amax做均加速运动;t1～t2段为匀速段，以vmax做匀速运动;t2～t3段为减速段，以－amax做匀减速运动。

2)不能加速到最大速度时，速度和加速度曲线，，0－t4段为加速段，以amax做均加速运动。

3关节空间建模与辨识

在对实际系统缺乏了解时，直接进行控制器设计往往存在风险和不便。因此，在控制器设计之前，首先通过辨识的手段，得到关节空间的信息，即支腿的模型信息。关节空间的控制任务为控制支腿跟踪由工作空间规划轨迹反解得到的位置曲线，由于支腿位置可看作是运动速度的积分，本节将对支腿的速度—电压关系进行建模和辨识。关节空间中，由直流电机驱动滚珠丝杆带动支腿上部运动，使支腿长度发生改变。不考虑负载力的影响，可将支腿的速度—电压开环传递。

为得到式中参数的具体数值，使用频率响应法对支腿进行辨识，其思想为测量系统在不同频率正弦信号输入的输出响应，以求得系统模型的待定参数［5］。对每个测试频率，运行6s，并记录其中2～4s的速度值，进行多次实验，将相同时间点处的速度值取平均值，求得各频率点幅值放大倍数和相移角度。

4关节空间控制器设计

在高精度位置控制器设计中，往往采用位置—速度双环控制方案。其中，速度内环控制的主要目的是抑制外部扰动，增强鲁棒性。通常希望通过内环控制器的校正作用，使得校正后的内环特性尽可能的接近名义模型，这样在外环控制器设计时，即可将名义模型视为实际的控制对象［6］。

已通过辨识实验得到关节空间的速度—电压模型，但由于未建模部分和外部扰动的影响，其和真实系统之间必然存在差距。选取状态变量:x1=y，x2=y，x3=f＇，则x=［yyf＇］T为包含了总扰动的扩张状态向量，将式(8)转换为扩张状态空间方程描述式中err为位置环参考信号r＇与当前位置y＇之差，errI为位置误差的积分。为加快镇定速度，在最后稳定阶段引入积分重置策略，即当检测到当前位置超过目标位置时，直接将errI重置为0，从而减小支腿运动超调的距离。

5实际控制系统与实验

Stewart平台控制系统的总体框架如图4所示。实际控制系统由上位机、下位机、Stewart平台组成。采用FPGA+DSP异构方案，FPGA和DSP通过外部存储器接口通信，实现传感器信息(增量式编码器、限位开关)的读取和控制信号(PWM信号)的产生［8，9］。接口板实现差分转单端、电平变换、光耦隔离等功能。驱动板由6对PWM信号控制，驱动平台按照给定轨迹运动。

为验证所设计控制系统性能，进行Stewart平台运动控制实验。平台具体尺寸为r=90mm，R=148mm，θ=110．0786°，φ=15．7965°。控制周期为1ms，限制平台位姿的位置分量的最大速度和最大加速度幅值为1mm/s和1mm/s2，姿态分量的最大速度和最大加速度幅值为1°/s和1°/s2。控制Stewart平台从中位点［00244．8273000］T运动到［4－1247．82733－1－1］T处，记录0～20s各时刻的支腿长度，并利用高斯—牛顿法求得对应的动平台位姿。动平台按照所规划的轨迹运动，运行平稳，且在开始运动和停止运动时均有妥善的过渡过程。其在0～5s的轨迹跟踪阶段，平台位置跟踪误差在0．01mm以下，姿态角跟踪误差在0．005°以下，并且在5．8s左右，动平台位姿镇定。最终平台稳定在［3．99989－0．99990247．827172．99992－1．00001－1．00002］T，偏差与位置传感器量化误差在一量级，因而可以将其忽略，认为平台已经稳定在给定位姿上。

6结论

实验结果表明:在本文所设计的控制系统控制下，高精度Stewart平台运行平稳，具有良好的跟踪精度，并且最终能够较快的稳定到目标位姿，取得了理想的控制效果。

参考文献:

［1］于阳．大型空间望远镜次镜精密调整机构研究［D］．长春:中国科学院研究生院(长春光学精密机械与物理研究所)，2016．

［2］梅莱．并联机器人［M］．北京:机械工业出版社，2014．

［3］黄真．并联机器人机构学理论及控制［M］．北京:机械工业出版社，1997．

［4］李云峰，杨兆宜，李长峰．精密并联机器人运动轨迹规划的研究［J］．机床与液压，2009，37(10):67－71．

［5］周儒勋，张泽龙，亓迎川．直流电机模型参数的直接辨识［J］．计算机仿真，2006，23(6):31－33．

［6］刘强．高性能机械伺服系统运动控制技术综述［J］．电机与控制学报，2008，12(5):603－609．

［7］叶东，周志炜，张飚，等．基于FPGA的多路光电编码器数据采集系统［J］．传感器与微系统，2006，25(5):45－47．

［8］张锋，彭正辉，任强，等．基于FPGA平台的光电编码器在探地雷达中的应用［J］．传感器与微系统，2015，34(8):149－151．

作者：武锡铜 周烽 王永 单位：中国科学技术大学 信息科学技术学院