[发明专利]一种无人自主飞行器自适应PID控制方法

权利要求书

1.一种无人自主飞行器自适应PID控制方法，其特征在于包括下述步骤：

步骤1、建立无人自主飞行器的六自由度运动模型；

步骤2、建立目标机动模型，将地面目标分成匀速直线运动和匀速圆周运动两种情况的二维平面运动，给定目标初始位置x₁、y₁，利用目标机动模型得到目标瞬时位置x_t、y_t；

步骤3、设计无人自主飞行器飞行轨迹仿真算法，具体包括：

3.1标准PID控制算法在离散域的控制形式：

u(k)=u(k-1)+K[e(k-1)+TTiΣi=0k-1e(i)+Tde.(k-1)]]]>

式中，u(k)为第k步控制系统的输出；K∈R为比例增益系数，R表示实数；e(k-1)∈R为第k-1步实际输出信号和期望输出信号的误差信号；T_i∈R为积分系数；T为控制系统的采样周期；i为整数，其值范围为0～k-1；T_d∈R为微分系数；

3.2BCTND控制算法在离散域的控制形式：

u′(k)=u′(k-1)+[-M‾c2x2(k-1)]+[-M‾x.2(k-1)]+[-M‾fwx2(k-1)]]]>

式中，x₁＝-e，u'为控制系统的输出；c₁,c₂∈R是常值系数；是由TDE预估的常值增益系数；f∈R是一个常值正数；w∈R代表有非线性阻尼引起的正系数，且w为随控制系统状态而变化的状态反馈自适应函数；

3.3用BCTND控制算法的系数表示PID控制算法的比例系数K_p、积分系数K_i、微分系数K_d，即：

Kp=[M‾(c2-c1+fw)]/TKi=KpT/Ti=KpT/[(c2-c1+fw)(c1c2+c1fw)-1]=M‾Kd=KpTd=Kp(c2-c1+fw)-1=M‾/T(c1c2+c1fw);]]>

3.4基于BCTND控制的无人自主飞行器自适应PID控制方法参数调整的具体步骤为：

3.4.1首先根据公式来确定常系数c₁和c₂；

3.4.2确定采样周期T，取T为系统硬件所能达到的最小采样周期；

3.4.3逐步增大使值由小到大变化直到系统开始震荡，停止调节；逐步增大f，使f值由小到大变化直到系统开始震荡，停止调节；

3.4.4由步骤3.3的公式确定本发明方法的控制系数K_p、K_i、K_d；

3.5无人自主飞行器控制律的设计

3.5.1将无人自主飞行器控制系统分为横向控制通道和纵向控制通道分别进行控制；

3.5.2纵向控制律设计为：

δz(k)=δz(k-1)+Kpθ[e(k-1)+TTIθ-1Σi=0k-1e(i)+TDθe.(k-1)]]]>

其中，

e(k-1)=q1(k-1)-θ(k-1)]]>

e.(k-1)=[e(k-1)-e(k-2)]/T]]>

式中，δ_z为无人自主飞行器方向舵的舵偏角；q₁(k-1)为铅垂平面内无人自主飞行器、目标的连线与地面坐标系x轴所在直线的夹角；为无人自主飞行器的俯仰角；

3.5.3横向控制律设计为：

其中：

e.(k-1)=[e(k-1)-e(k-2)]/T]]>

式中，δ_y为无人自主飞行器升降舵的舵偏角；q₂(k-1)为水平平面内无人飞行器、目标的连线与参考线(取地面坐标系x轴所在直线)的夹角；为无人自主飞行器的偏航角；w₂是一个可变的自适应参数，其值等于水平面内q₂的变化率，即