一种固定翼无人机抗侧风的飞行控制方法
【技术领域】：
[0001] 本发明属于无人机技术领域，特指一种固定翼无人机抗侧风的飞行控制方法。
【背景技术】：
[0002] 当前无人机技术迅猛发展，远距离侦查监视，定点打击，航空测绘等任务都需要无 人机具备精确航迹跟踪的能力，各种无人机航迹跟踪算法也受到了海内外众多专家学者的 研究和关注。目前广泛使用的航迹跟踪算法主要有等角模式制导方法、胡萝卜追踪算法、非 线性算法、矢量场算法等，这些方法都较易于实现，各有优缺点，控制方法和控制效果也不 尽相同。
[0003] 大气环境中风的扰动无处不在，而且绝大多数时候都在不规则的变化，最典型的 有突风和风切变，所以对于航迹跟踪算法最基本的要求是不仅要能在有风的扰动的情况下 保证航迹跟踪的精确性，还要求有鲁棒性。随着无人机单兵化，小型化的不断发展，对于小 型无人机侧风干扰下精确航迹跟踪能力的需求会不断提高，航迹跟踪算法还需要进一步被 研究和完善。
【发明内容】
[0004] 在现有的等角模式制导方法下，固定翼无人机在空中巡航的过程中，由于侧风扰 动，导致航迹跟踪精度不够高，容易出现无人机横侧向的振荡，影响飞行稳定和安全。本发 明针对上述问题，在现有的等角模式制导算法上进行了改进，提出了一种固定翼无人机抗 侧风的飞行控制方法。其在飞行过程中，采用GPS导航信息合成出无人机当前的地速方向， 控制无人机地速方向对准目标航路点；根据无人实时的机侧向航迹偏差，采用增益负反馈 修正侧向的航迹偏差;根据无人机实时的侧向航迹偏差，采用可变的增益系数，生成修正指 令，从而大大提高了无人机抗侧风扰动的能力，并能有效提高无人机航迹跟踪速度和精度。
[0005] 本发明的技术方案是：
[0006] -种固定翼无人机抗侧风的飞行控制方法，其特征在于，无人机在飞行过程中，采 用GPS导航信息合成出无人机实时地速方向，控制无人机地速方向对准目标航路点，根据无 人实时的机侧向航迹偏差，采用增益负反馈修正侧向的航迹偏差，包括以下步骤：
[0007] S1，读取无人机当前的GPS坐标与自驾仪系统预设的航点GPS坐标，根据两者的坐 标，计算地面坐标系下的相对坐标。
[0008] S2，根据无人机和预设航点在地面坐标系下的相对坐标计算目标航向角。
[0009] S3,读取无人机当前的GPS导航信息中的X轴速度和Y轴速度，通过计算得到地面坐 标系下无人机实时地速方向，即无人机实时航迹角。
[0010] S4,用目标航向角与航迹角做差，得到航向角偏转指令。
[0011] S5,根据无人机和预设航点在地面坐标系下的相对坐标，计算无人机相对于航迹 的侧向航迹偏差。
[0012] S6,根据无人机实时的侧向航迹偏差，侧向航迹偏差乘以增益系数K得到航向角修 正指令;其中增益系数K为可变的增益系数，其采用可变的增益系数赋值的方法进行赋值， 例如分段式赋值。增益系数分段式赋值方法如图2所示。
[0013] S7,航向角偏转指令加上航向角修正指令得到航向角控制指令。
[0014] 与现有技术相比，本发明的优点是：
[0015]通过采用GPS导航信息合成的无人机地速方向，放宽对于制导过程中无人机航向 角的约束，直接控制无人机地速方向对准目标航路点，可以很好的抵抗侧风的扰动，减小航 迹偏差，使无人机保持预设航迹;对侧向航迹偏差采用增益负反馈的控制器，能够有效提高 航迹跟踪速度;根据当前无人机的航迹偏差，采用可变的增益系数赋值的方式，根据连续函 数计算出对应的增益系数，生成航迹偏差修正指令，能够加快偏差收敛速度并避免产生振 荡，可以有效提高航迹跟踪精度，提高无人机执行任务的精度水平。
【附图说明】：
[0016] 图1为本发明的流程图；
[0017] 图2为分段式增益系数赋值的取值示意图。
[0018] 图2中，横坐标e表示偏差，即预设值与实际值的差，纵坐标表示增益系数Κ，随着偏 差的不断减小，增益系数由极小值逐渐增大，最后稳定到极大值。e min，emax分别为5和50， Kmin，Kmax 分别为0.012和0.048。
【具体实施方式】：
[0019] 下面结合附图对本发明做进一步描述。
[0020] 参照图1，为本发明的流程图，如图1所示，一种固定翼无人机抗侧风的飞行控制方 法，步骤如下：
[0021] S1，读取无人机当前的GPS坐标与自驾仪系统预设的航点GPS坐标，根据两者的坐 标，计算地面坐标系下的相对坐标。
[0023] 其中，Ion和lat分别是GPS坐标中的经度和炜度，lor/和laV是相对坐标的参照基 准点的经度和炜度，通常以起飞点为基准点，R为地球半径。
[0024] S2，根据无人机和预设航点在地面坐标系下的相对坐标计算目标航向角。
[0026] Heading = atan2( Δ X，Δ y)
[0027] 其中，Xe3和％是无人机当前位置在地面坐标系下的相对坐标，x4Pya是目标航路点 的相对坐标，Heading是目标航向角。
[0028] S3,读取无人机当前的GPS导航信息中的X轴速度和Y轴速度，通过计算，得到地面 坐标系下无人机实时地速方向。
[0029] gpsheading = atan2(Vx, Vy)
[0030]其中，Vx和Vy分别是无人机的X轴速度和Y轴速度，gpsheading是地面坐标系下无人 机实时航迹角。
[0031] S4,用目标航向角与航迹角做差，得到航向角偏转指令Yawl。
[0032] Yawl =Heading-gpsheading
[0033] S5,根据无人机和预设航点在地面坐标系下的相对坐标，计算无人机相对于航迹 的侧向航迹偏差d。
[0035] 其中，a和yb是上一个目标航路点的相对坐标。
[0036] S6,根据侧向航迹偏差，采用可变的增益系数赋值的方法，例如分段式赋值，计算 增益系数K，乘以航迹偏差，得到航向角修正指令Yaw2。增益系数分段式赋值方法如图2所 示。e min，emax*别为5和50，Kmin，K歷分别为0 · 012和0 · 048 〇
[0037] Yaw2=K · d
[0038] S7,航向角偏转指令加上航向角修正指令得到航向角控制指令Yaw。
[0039] Yaw = Yawl+Yaw2〇
[0040] 以上包含了本发明优选实施例的说明，这是为了详细说明本发明的技术特征，并 不是想要将
【发明内容】
限制在实施例所描述的具体形式中，依据本
【发明内容】
主旨进行的其他 修改和变型也受本专利保护。本
【发明内容】
的主旨是由权利要求书所界定，而非由实施例的 具体描述所界定。
【主权项】
1. 一种固定翼无人机抗侧风的飞行控制方法，其特征在于，在飞行过程中，采用GPS导 航信息合成出无人机实时地速方向，控制无人机地速方向对准目标航路点，根据无人实时 的机侧向航迹偏差，采用增益负反馈修正侧向的航迹偏差，包括以下步骤： S1:读取无人机当前的GPS坐标与自驾仪系统预设的航点GPS坐标，根据两者的坐标，计 算地面坐标系下的相对坐标； S2:根据无人机和预设航点在地面坐标系下的相对坐标计算目标航向角； S3:读取无人机当前的GPS导航信息中的X轴速度和Y轴速度，通过计算得到地面坐标系 下无人机实时地速方向，即无人机实时航迹角； S4:用目标航向角与航迹角做差，得到航向角偏转指令； S5:根据无人机和预设航点在地面坐标系下的相对坐标，计算无人机相对于航迹的侧 向航迹偏差； S6:根据无人机实时的侧向航迹偏差，侧向航迹偏差乘以增益系数K得到航向角修正指 令； S7:航向角偏转指令加上航向角修正指令得到航向角控制指令。2. 根据权利要求1所述的固定翼无人机抗侧风的飞行控制方法，其特征在于，根据无人 机实时的侧向航迹偏差，步骤S6中采用可变的增益系数K，生成航向角修正指令，增益系数K 可采用基于偏差变化的分段式赋值。
【专利摘要】本发明提出了一种固定翼无人机抗侧风的飞行控制方法，无人机在飞行过程中，采用GPS导航信息合成出无人机当前的地速方向，控制无人机地速方向对准目标航路点；根据无人实时的机侧向航迹偏差，采用增益负反馈修正侧向的航迹偏差；根据无人机实时的侧向航迹偏差，采用可变的增益系数，生成修正指令，从而大大提高了无人机抗侧风扰动的能力，并能有效提高无人机航迹跟踪速度和精度。其解决了现有固定翼无人机在空中巡航的过程中，由于侧风扰动，导致航迹跟踪精度不够高，容易出现无人机横侧向的振荡，影响飞行稳定和安全的问题。
【IPC分类】G05D1/10, G05D1/08
【公开号】CN105573340
【申请号】CN201610030454
【发明人】王鹏, 侯中喜, 高俊, 陈清阳, 鲁亚飞, 冒云慧, 李茹, 郭天豪
【申请人】中国人民解放军国防科学技术大学
【公开日】2016年5月11日
【申请日】2016年1月15日