基于冗余传感数据的无人机鲁棒控制系统设计

(整期优先)网络出版时间:2021-05-06
/ 2

基于冗余传感数据的无人机鲁棒控制系统设计

范义龙,崔宗星

中国电子科技集团公司第二十研究所 陕西西安 710000

摘要:本文提出了一种由无人机传感系统所得到的测量数据转变为控制系统所需的导航数据的矩阵计算方法,之后提出了无人机经向和和横向运动的数学模型,最后基于60935c78515dd_html_2af30f16ace2ef40.gif聚合理论,设计了一种鲁棒控制器,并通过模拟仿真得到了控制效果,仿真结果表明该控制器具有一定的鲁棒性,可以在各类无人机等运动平台中得到广泛应用。

  1. 引言

如今无人机平台在越来越多的领域取得广泛应用,各项相关技术也随之迅猛发展,飞行控制系统设计便是其中一个重要研究方向。由于无人机飞行环境的不确定性以及内部传感器的不稳定性等因素,飞行控制系统必须能够在各类外部干扰的条件下保持稳定,即保持系统鲁棒性。

无人机内部通过装载各类传感设备,为其控制系统提供所需参数,如速度、高度、倾角等。为提升测量数据的可靠性和准确性,传感器的配置通常具有测量数据非正交且数据冗余等特点。因此无人机的控制系统要在传感系统提供的大量冗余数据中进行过滤,而具体选择哪些数据则要根据无人机的特点和需求综合考虑。通常情况下,无人机控制系统和传感系统的功能示意图如图1所示。

60935c78515dd_html_2ecb70dcca73cdd6.gif

图1 无人机系统功能示意图

由此,无人机的控制系统设计主要可分为两个部分,其一是在传感系统得到的众多冗余数据中选择适当的参数并开发数据聚合算法,其二是设计具有一定鲁棒性的控制系统。

  1. 参数选择

一种比较成熟的方法是将描述无人机运动的向量集合视为一种类似圆锥体的形式[1],各单轴传感器的测量向量均沿圆锥形的母线排布。综合考虑系统精度与成本,可以使用6个传感器[2],其中5个传感器沿圆锥形法线方向排布,1个传感器沿圆锥形轴线方向排布,测量数据组成的坐标系如图2所示,其中60935c78515dd_html_8bc7019ec5a159f3.gif表示导航坐标系;60935c78515dd_html_b9f71e6eaa7bb5a2.gif表示测量坐标系(60935c78515dd_html_d940c4d26c045e92.gif沿法线方向,60935c78515dd_html_2ea5c9b82700bd0f.gif沿轴线方向向下。

60935c78515dd_html_2cd4afb11782ff63.gif

图2 多传感数据坐标排布示意图

无人机内部传感器测量数据和所需的导航信息的关系可由下式表示:

60935c78515dd_html_a62aab40659be5c3.gif (1)

其中,60935c78515dd_html_6912a3050ac3b8fd.gif为角速度在测量坐标系中的投影向量,60935c78515dd_html_f9557a761bc69ec3.gif为角速度在导航坐标系中的投影向量;60935c78515dd_html_7c25dca8774cd853.gif为传感器数量;矩阵60935c78515dd_html_5b45ae986d179620.gif表示了导航坐标系向测量坐标系的传递矩阵,见式(2)。

60935c78515dd_html_44181900442aa291.gif (2)

由式(1)可知,投影向量60935c78515dd_html_df2dfd7e7b7f380c.gif可表示为:

60935c78515dd_html_c1b71714c6b2ac31.gif (3)

基于广义逆矩阵算法可知:

60935c78515dd_html_bcbcff7f30919787.gif (4)

  1. 无人机的数学模型

一种无人机的线性数学模型可由下式表示:

60935c78515dd_html_9a634b5047239b6b.gif (5)

无人机的纵向动作表示为向量60935c78515dd_html_5d4133ebdf074332.gif

60935c78515dd_html_931144bff4e3f356.gif

其中,60935c78515dd_html_7562f1ce64d1ff1c.gif为水平和垂直方向的真实速度;60935c78515dd_html_6edcccc5b0cf16b4.gif为倾斜角速度;60935c78515dd_html_aad53988288bd555.gif为倾斜角度;60935c78515dd_html_89d8e36b545339b4.gif为飞行高度;60935c78515dd_html_12df78b4457f7c6e.gif为电机运行角速度。

无人机纵向动作由升降舵以及引擎的工作状态共同影响,控制向量可表示为:

60935c78515dd_html_d625157b3ea89491.gif

其中,60935c78515dd_html_4893870ab3ec60a1.gif表示升降舵的偏差因数,60935c78515dd_html_68bfe9a4fbf0d90a.gif表示引擎的输出功率因数。输出向量可表示为:

60935c78515dd_html_fd3cdf18a4611139.gif

其中,60935c78515dd_html_1da5776449a9677.gif表示真实速度。

其纵向动作可由如下公式表示:

60935c78515dd_html_744e928757b58537.gif (6)

由此可知,矩阵A及矩阵B可表示为以下公式:

60935c78515dd_html_ab0240f6ff6980de.gif (7)

60935c78515dd_html_19a0a84600470bf3.gif (8)

可基于无人机的数学模型,即根据式(5)设计鲁棒控制系统,矩阵60935c78515dd_html_b4960588106d6ece.gif60935c78515dd_html_f94e7b5c8f01c28f.gif中的参数值可由MatLab中的飞行仿真程序得到[3]

对于无人机模型的横向运动,状态向量可表示为:

60935c78515dd_html_4ce6ae80a90d44d.gif

其中,60935c78515dd_html_5b740a6f2f03783a.gif60935c78515dd_html_6bc4c56b5faab39c.gif分别表示侧滚和偏航的角速度,60935c78515dd_html_f5d72eb3bad8c88c.gif60935c78515dd_html_3adf221157e54874.gif分别表示侧滚和偏航的角度,控制向量表示为:

60935c78515dd_html_2e3a1897e1724e0c.gif

其中,60935c78515dd_html_1e8844ad207d4511.gif60935c78515dd_html_2a019205e839b5e0.gif分别表示侧翼和方向舵的偏移角度。输出向量可表示为:

60935c78515dd_html_2541750477cc0f03.gif

其横向动作的公式如下:

60935c78515dd_html_c51517635c0d3c77.gif (9)

根据式(9)可知,此时矩阵A及矩阵B表示为:

60935c78515dd_html_552cc17f4b46c63e.gif (10)

60935c78515dd_html_ed9824b472c6ee85.gif (11)

  1. 控制系统设计与仿真

用于实现无人机控制的聚合算法由无人机的数学模型和鲁棒控制系统模型共同组成,二者的传递函数分别用60935c78515dd_html_d8a945644522ab5f.gif60935c78515dd_html_1383b35eb251b12e.gif表示。该系统通常具有2个输入和2个输出变量,外部输入变量60935c78515dd_html_2075c0b5f2864f90.gif由诸如指令信号、扰动和噪声等组成;输入变量60935c78515dd_html_85f6e37d53fb2e66.gif表示控制信号;输出变量60935c78515dd_html_6ffc37f4d073e46d.gif用于表示控制结果的好坏,例如当60935c78515dd_html_e783c4a6d308b88c.gif表示控制结果与输入指令的误差时,在理想条件应有60935c78515dd_html_6f8ca89d1b9745ee.gif;输出变量60935c78515dd_html_7d6d83b0d3a6f7cd.gif表示观测信号,用于系统反馈。用符号60935c78515dd_html_a7a105ae93cbb827.gif表示由60935c78515dd_html_e33b28ade28c7091.gif的传递函数,基于60935c78515dd_html_46ec96816f7317d1.gif控制理论进行控制系统设计的主要任务便是得到函数60935c78515dd_html_3aec92c8e284e6cc.gif,使范数60935c78515dd_html_a3354805f2882178.gif最小,概括来讲,其优化准则如下式所示:

60935c78515dd_html_5ed71c32fb2e4b60.gif (12)

其中,60935c78515dd_html_2652a0b3b33afd42.gif60935c78515dd_html_137824e2b3a24d20.gif60935c78515dd_html_57e47bb6873e13e5.gif为灵敏度函数的加权传递函数。矩阵中的三个行向量分别表示灵敏度函数,控制偏差的灵敏度函数,以及对应补偿的灵敏度函数。

使用上述优化准则,可以解决如无人机控制等实际应用场景中的复杂优化需求。

本文针对无人机在纵向运动中的速度和高度数据利用Matlab进行了模拟仿真,具备鲁棒控制器的聚合算法对于无人机速度和高度控制的仿真结果分别如图3和图4所示,图中虚线表示参数受到扰动的模拟系统,实线表示理想对照系统,模拟结果表明本文所述的控制系统能够在一定程度上消除在实际应用场景中参数的扰动对控制系统带来的不良影响。

60935c78515dd_html_128b542bc0b76120.png

图3 无人机速度仿真结果

60935c78515dd_html_acf63512ab2d0e38.png

图4 无人机高度仿真结果

  1. 结论

仿真结果表明,将具备冗余配置的传感器系统和鲁棒控制系统相结合,可以提高无人机导航系统的可靠性以及控制系统的鲁棒性,改善无人机在复杂真实环境下的运行状态,能够在众多领域开展实际应用。


参考文献

[1]A.D.Epifanov. Redundant Systems of Aircraft Control[J]. Moscow: Mashinostroenie,1978.p.178.

[2]O.A.Sushchenko. Nonorthogonal Redundant Configurations of Inertial Sensors [C]. IEEE 4th International Conference Actual Problems on Unmanned Aerial Vehicles Developments,October 17-19,2017,73–78.

[3]J.C.Jeromel. Convex Analysis of Output Feedback Control Problems: Robust Stability and Performance[C]. IEEE Transactions on Automatic Control,vol.41,no.7, 1996,903–1003.