一种基于转台控制的自适应复合控制方法

摘要

一种基于转台控制的自适应复合控制方法，属于高精度转台伺服控制技术领域，通过自适应PID控制参数和速度、加速度前馈复合控制方法，满足了不同运动模式下控制精度和相应速度的要求，且很好地解决了不同模式切换时带来的转台输出冲击问题，从而极大地提高了转台的动态控制性能。

说明书

技术领域

本发明涉及一种基于转台控制的自适应复合控制方法。

背景技术

高精度转台是一种重要的惯导标定测试和半实物仿真试验设备，通过其可以给被测产品提供精确的位置、速率和加速度激励，从而对被测件进行误差系数标定、频率响应测试，或给被测件提供模拟真实飞行轨迹的连续物理姿态。

随着惯导技术的不断发展，不但其位置、速率的测量精度越来越高，加速度、带宽等动态工作性能也越来越高。因此，对测试转台的精度指标和动态性能的要求也越来越高。特别是对于高性能的仿真测试转台，加速度和双十带宽指标是决定控制系统半实物仿真试验能力的关键因素，同时也是标志设备性能的最关键指标。

为满足加速度和双十带宽指标要求，在仿真转台的控制系统设计中，高性能的控制算法和快速的伺服控制周期是关键要素。通过优化控制算法，可以提高转台的动态控制品质；通过较小伺服控制周期，可以提高动态跟踪性精度，也可以提高系统带宽。

目前，对于仿真转台的控制算法研究和应用虽然比较多，但要么是关注在各种先进的控制理论研究以解决某类特殊或复杂的问题，而难以推广以解决普遍的工程问题；要么是直接采用工程上比较成熟的PID等控制算法，简单实用，难以满足高性能的控制要求。

此外，由于仿真转台工作在位置、速率、角振动、仿真等多种运动模式下，各运动模式要求的控制精度和响应速度不同，其控制策略和参数也不同。在转台连续运动过程中从一种运动模式切换到另一种模式时，由于控制参数的突变，会带来输出的冲击，导致控制品质下降，甚至失控。

传统的转台PID控制算法采用如下的离散公式，：

上式中u(n)代表本控制周期内控制输出量；e(n)代表本控制周期内目标位置和反馈位置的差值；K_p、K_i和K_d代表比例、积分、微分系数，均是固定的值。

由于在动态转台的伺服运动控制过程中，每帧控制周期内，转台的目标位置和反馈位置都是动态变化的，特别是在做高频角振动和仿真之类的复杂运动时，不同帧周期内e(n)值的变化非常大，因此固定的K_p值难以满足快速跟踪的动态控制要求。此外，转台在执行角振动、仿真等动态模式的运动时，所需要的K_p值比执行位置、速率等静态模式的运动时要大很多。如果在运动过程中由静态到动态运动模式切换时，在新的帧周期内直接给入切换后动态模式的很大的K_p值，会造控制输出量的突变，对转台运动造成冲击，从而导致转台失控。此外，对于加速度和双十带宽要求比较高的仿真转台中，单纯的PID算法难以满足要求。

发明内容

本发明的技术解决问题是：克服现有技术的不足之处，提供一种基于转台控制的自适应复合控制方法，解决动态控制精度和模式切换带来的输出量冲击问题。

本发明的方法的技术方案是：一种基于转台控制的自适应复合控制方法，包括下列步骤：

(1)将转台的运动模式分为位置、速率、角振动、仿真4种模式；通过前期让转台在每种单一运动模式下连续运行，调试得到各模式下相应的控制参数；控制参数中积分系数K_i和微分系数K_d在各种运动模式下是相同的，其余控制参数在各种运动模式下不同，分别记为：

位置模式下：比例系数下限值K_pmin1、比例调节系数K_pscale1、比例系数上限值K_pmax1、速度前馈系数K_vff1、加速度前馈系数K_aff1；

速率模式下：比例系数下限值K_pmin2、比例调节系数K_pscale2、比例系数上限值K_pmax2、速度前馈系数K_vff2、加速度前馈系数K_aff2；

角振动模式下：比例系数下限值K_pmin3、比例调节系数K_pscale3、比例系数上限值K_pmax3、速度前馈系数K_vff3、加速度前馈系数K_aff3；

仿真模式下：比例系数下限值K_pmin4、比例调节系数K_pscale4、比例系数上限值K_pmax4、速度前馈系数K_vff4、加速度前馈系数K_aff4；

(2)转台的控制采用计算机离散控制的方法，以周期为T循环进行伺服运算，每次伺服运算时，重新置入新的控制参数，每一个控制参数的上一帧记为n-1，本帧记为n；n为大于1的正整数；

(3)当转台以某种运动模式开始连续运动时，每次进入新的循环周期后，首先计算出本控制周期内目标位置和反馈位置的误差值e(n)，并从寄存器读入上一帧寄存下来的误差值e(n-1)；所述目标位置和反馈位置由外部系统测量得到；

然后按照下式计算本帧的比例系数K_p(n)：

其中e_max为最大误差限值，一般取100；

再按照下式计算本帧的控制输出量u(n)：

其中，V_com(n)和A_com(n)分别为当前帧的速度指令值和加速度指令值，由外部输入给定；

(4)当转台在连续运动过程中运动模式发生变化时，在新周期帧内，首先判断新模式的比例系数下限值K_pmin是否小于旧模式的值；当小于时，直接给入新模式的各控制参数，计算并得到盖帧的控制输出量u(n)；

当新模式的比例系数下限值K_pmin大于旧模式的值时，在随后的连续控制帧内逐步增加K_pmin的值(一般加1)，直到K_pmin的值达到新模式的K_pmin值；所述每一帧参数变化后均计算并得到该帧的控制输出量u(n)；

(5)同理，当转台连续运动过程中运动模式发生变化时，速度前馈系数K_vff和加速度前馈系数K_aff的值也安照上述方法进行判断；当新模式的值小于旧模式的值时，直接给入；当新模式的值大于旧模式的值时，在随后的连续控制帧内逐步增加K_vff和K_aff的值(一般加1)，直到K_vff和K_aff的值达到新模式的K_pmin值；

(6)计算得到的控制输出量u(n)，经D/A转换，送功放电路放大后，驱动转台电机进行转动。

本发明与现有技术相比的优点在于：采用了通过当前误差值调节比例系数和根据不同运动模式采用不同的控制参数，并在运动模切换时牵引K_pmin的方法，以及增加可动态调整的速度前馈系统和加速度前馈系数的复合控制方法，起到了根据当前运动模式和实际误差值自动调整控制参数的自适应控制算法以及运动模式切换时输出量平稳过渡的作用，从而达到了提高转台动态控制品质、提高加速度能力和双十带宽响应频率，以及在运动过程中模式切换时没有冲击的好处。通过上述转台自适应复合控制方法，满足了不同运动模式下控制精度和响应速度的要求，且很好地解决了不同模式切换时带来的转台输出冲击问题。

附图说明

图1为本发明方法流程图。

具体实施方式

本发明一种基于转台控制的自适应复合控制方法，包括下列步骤：

(1)本发明首先在传统PID控制算法的基础上，增加了速度和加速度前馈，采用复合控制的算法。且将原来固定的比例系数K_p变为每控制帧内可动态调整的K_p(n)。同时，将每帧的速度和加速度前馈系数也变为可调整的K_vff(n)和K_aff(n)。具体的控制算法如下式：

(2)每一帧的K_p(n)是在下限值K_pmin和上限值K_pmax之间动态变化的。

(3)位置模式下，取下限值K_pmin1＝20。比例调节系数K_pscale1＝0.2，最大误差限值e_max＝100，即K_pmax1＝K_pmin+K_pscale×e_max＝40。取K_vff1＝10，K_aff1＝20。

(4)角振动模式下，取下限值K_pmin3＝80。比例调节系数K_pscale3＝0.5，最大误差限值e_max＝100，即K_pmax3＝130。取K_vff3＝60，K_aff1＝90。

(5)每控制帧中实际采用的K_p(n)值随当前实际的位置误差e(n)值而进行自适应调整，即

(6)在转台控制程序中，设置三个布尔型的状态标志量Kpdriver、 Kvdriver和Kadriver，分别表示是否需要进行控制参数K_p、K_vff和K_aff的牵引，其初始化值均为F。

(7)在转台以角振动模式开始运行后，首先根据K_pmin3、K_pscale3、K_pmax3、>max以及当前e(n)的值，按式(2)计算K_p(n)值。

然后根据K_p(n)、K_vff3(n)、K_aff3(n)以及其它参数，按式(1)计算控制输出量u(n)。保持Kpdriver、Kvdriver和Kadriver的值均为F。

(8)此后，当运动模式由角振动模式切换到位置模式时，直接给入位置模式的控制参数K_pmin1、K_pscale1、K_pmax1、K_vff1、K_aff1，并保持Kpdriver、Kvdriver>

(9)再此后，当运动模式由位置模式切换到角振动模式时，取K_pmin(n)＝>pmin(n-1)+1，并设Kpdriver＝T；取K_vff(n)＝K_vff(n-1)+1，并设Kvdriver＝T；取>aff(n)＝K_aff(n-1)+1，并设Kadriver＝T。

(10)在随后的若干个控制周期内，继续增加K_pmin(n)，直到达到K_pmin3时，设K_pscale(n)＝K_pscale3，并设Kpdriver＝F，表示比例系数牵引完成；继续增加K_vff(n)，直到达到K_vff3时，设Kvdriver＝F，表示速度前馈系数牵引完成；继续增加K_aff(n)，直到达到K_aff3时，设Kadriver＝F，表示加速度前馈系数牵引完成。

通过上述转台自适应复合控制方法，满足了位置和角振动不同运动模式下控制精度和响应速度的要求，且很好地解决了从位置模式切换到角振动模式时带来的转台输出冲击问题。