[发明专利]一种基于积分器的控制律平稳切换方法

说明书

技术领域

本发明涉及无人机飞行控制领域，具体地说是指一种基于积分器的控制律平稳切换方法。

背景技术

无人机飞行控制系统通常由飞控计算机、传感器和伺服机构组成，飞控计算机根据输入的传感器信息、存贮的有关数据以及通过测控链路上传的遥控指令与数据，经过判断、运算和处理后，输出指令给伺服机构，控制舵面、发动机以及刹车量，进而控制飞机的速度、姿态和轨迹来完成各种模态的控制任务。与有人机相比，无人机的飞行控制系统应具有高度的自主性和应付复杂环境的能力，针对不同的飞行阶段应自主采用相应不同的控制策略来完成相应的控制目标。通常的控制目标包括：稳定及操纵飞机的姿态角；稳定及操纵飞机的重心运动，包括飞行高度、空速、航迹等；操纵飞机由危险高度自动拉起复飞；进场着陆时自动跟踪下滑线并保证飞行速度的控制等等。由于不同的飞行阶段的控制策略不同，相应的控制律结构和参数均可能出现较大差别。飞行过程中，随着飞行状态的变化，将会出现不同控制律的切换，此时，若不引入控制律平稳切换技术，则会出现输出至伺服机构的控制量的突跳，由此引起的飞机过载突变，对飞行安全产生不利影响。

图1所示的是飞行控制中控制律切换原理示意图，飞行的基本原理是机载飞行控制计算机计算被控量y(t)与期望值r(t)之间的偏差e(t)，并根据控制律解算得到控制量u(t)，该控制量输出至饲服作动设备，进而控制飞机。现有的控制律平稳切换技术常采用多模态同步运算控制平稳切换方法，在图1中，控制律A的输出为u_a(t)，控制律B的输出为u_b(t)，其中的软化处理通常选择线性软化方法，当控制律由A转至B时，在控制律总输出口来总体平滑瞬变过程，即利用软化环节使被切换的控制律A逐渐淡出，需接入的控制律B逐渐淡入。切换过程中，系统所执行的控制律输出为：

u(t)＝u_a(t).(1-t/T)+u_b(t).t/T    (1)

其中，t为软化开始后记录的时间，T为软化时限。切换时的平缓程度可以通过选择软化时限T来进行调节，软化时限越长，过渡过程越平缓。

多模态同步运算控制平稳切换方法的特点是比较直观，具有良好的瞬变抑制效果，平缓程度可以根据实际情况设定不同的软化时限来进行调节。但实现过程较为繁琐，需要包括切换瞬间输出量旧值的记录、软化开始后计时器的实现、软化时限的判断、软化时限内进行线性软化计算等等。同时，在切换过程中，不同控制律的重叠计算对系统的稳定性会产生影响，因此还必须通过足够的仿真试验来调整软化时限T，以获得满意的瞬变过程。

发明内容

本发明的目的是提出一种基于积分器的控制律平稳切换方法，该方法利用了PID(比例-积分-微分)控制器结构中的积分器环节，通过简单的处理，实现了控制律的平稳切换。

本发明的控制律平稳切换方法通过以下步骤实现：

步骤一：计算控制律切换时刻(t₀时刻)的控制量u_a(t₀)、u_b(t₀)。

步骤二：令u_a(t₀)＝u_b(t₀)，解算切换时刻控制量u_b(t₀)的积分器的初值x₀。

步骤三：将积分器的初值x₀带入控制律B得到控制输出。

本发明控制律平稳切换方法的优点在于：

(1)实际运行过程中只针对接入模态进行一次计算，运行效率高，控制律切换实现更为简单；

(2)无重叠运算，保证飞机控制系统的稳定性。

附图说明

图1是多模态同步运算控制平稳切换示意图；

图2是本发明所提供的一种基于积分器的控制律平稳切换示意图；

图3是控制切换实例示意图；

图4不采用软化的结果图；

图5是采用线性软化的结果图；

图6是应用本发明提供的切换方法进行积分器初值软化后的结果图。

具体实施方式

下面结合附图和具体实例对本发明作进一步详细说明。

利用经典控制理论解决飞行控制律设计的问题时，PID控制器由于其结构简单、鲁棒性强以及易于实现的特点被广泛的应用。PID控制器由比例环节、积分环节和微分环节三部分组成，其输入偏差e(t)与输出控制量u(t)的关系为：