[发明专利]一种基于曲率补偿的横侧向曲线航迹跟踪方法

说明书

技术领域

本发明涉及一种飞行器航迹跟踪控制方法，属于航迹跟踪控制技术领域，具体地说，是指一种基于曲率补偿的横侧向曲线航迹跟踪方法。

背景技术

无人机也称无人航空器或遥控驾驶航空器，是一种由无线电遥控设备控制，或由预编程序操纵的非载人飞行器，拥有众多有人驾驶飞机所不具有的优点，可执行各种作战和训练保障等任务，具有广阔的军事应用前景。

随着无人机的应用领域不断扩大，对无人机的飞行要求也越来越苛刻，对预定航迹进行准确、快速的跟踪便是其中之一。无人机的航迹跟踪控制，主要通过无人机的飞行控制系统来实现。这样，如何通过调节无人机的飞行控制系统来使无人机能够更好更快的跟踪预定航迹，对无人机整体性能的提高以及航空事业的发展都有很重要的意义。

航迹规划阶段，所规划航迹由一组离散航路点组成，相邻点之间距离一个规划步长。传统的侧偏距控制原理如图1所示。

由航迹规划算法所得航迹点相邻点两两连线得到所规划航迹（t1-t2-t3-t4），通过实时计算无人机当前位置与所规划航迹之间最近距离得到无人机侧偏距S，在横侧向控制回路的作用下，无人机逐渐向t₃航迹点靠近，无人机到达t₃航迹点后，切换跟踪下一个航迹段t₃-t₄。

由于无人机跟踪航迹为折线，在跟踪过程中会存在较大的跟踪误差；尤其当航迹点较密时，会造成无人机无法跟踪规划航迹。

发明内容

本发明的目的是为了解决上述问题，提出一种基于曲率补偿的横侧向曲线航迹跟踪方法，通过引入拉格朗日多项式插值算法，对航迹规划所得离散航迹点进行曲线拟合处理，得到曲线航迹，并引入曲线曲率作为补偿量，加入横侧向航迹跟踪控制器设计中，明显改善了对参考航迹的跟踪效果，提高了跟踪精度。

本发明的一种基于曲率补偿的横侧向曲线航迹跟踪方法，具体包括如下步骤：

步骤一：通过航迹规划模块得到参考航迹的离散航路点数据。

步骤二：通过拉格朗日分段多项式插值方法，对步骤一所得离散航路点数据进行分段插值拟合处理，得到曲线航迹。

步骤三：计算无人机当前时刻侧偏距，以及参考航迹上距飞机最近点坐标。

步骤四：通过曲率计算公式，计算步骤三所得参考航迹上距飞机最近点处曲率值。

步骤五：重复步骤二～步骤四，并将步骤三所得侧偏距和步骤四所得曲率值作为无人机横侧向控制器的输入量，完成整个曲线航迹跟踪过程。

本发明的优点在于：

(1)本发明提供的方法通过对参考航迹进行曲线插值拟合处理，使跟踪过程中航路点的过渡段更加平滑，跟踪误差减小。

(2)本发明提供的方法将曲率值作为补偿量加入横侧向控制器中，而曲线曲率代表了曲线的弯曲程度以及弯曲方向，可以为横侧向控制器提供航迹方向走势信息，从而更好地跟踪航迹。

附图说明

图1是折线航迹侧偏距控制原理图；

图2是本发明中航迹规划模块所得离散航路点；

图3是本发明中离散航路点曲线拟合处理过程示意图；

图4是本发明中无人机航迹跟踪控制器结构示意图。

具体实施方式

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

本发明提出了一种基于曲率补偿的横侧向曲线航迹跟踪方法，首先通过航迹规划模块得到参考航迹的离散航路点数据，然后通过拉格朗日分段多项式插值方法，对离散航路点进行分段插值拟合处理，从而得到曲线航迹，实时计算无人机当前位置距离参考曲线航迹段的最近距离从而得到无人机侧偏距，同时可以得到参考航迹上距飞机最近点处坐标，通过曲率计算公式可以得到该对应点处曲率值，将上述所得无人机侧偏距和最近点处曲率作为无人机横侧向控制器的输入量，完成曲线航迹跟踪控制。

本发明的一种基于曲率补偿的横侧向曲线航迹跟踪方法，包括以下几个步骤：

步骤一：通过航迹规划模块得到参考航迹的离散航路点数据。

根据无人机起始点与目标点，通过航迹规划模块，得到无人机从起始点到达目标点的离散航路点数据，如图2中P(1)，P(2)，……，P(n)所示航迹，P(1)为起始点，p(n)为目标点，n为航迹上航路点数量。

步骤二：通过拉格朗日分段多项式插值方法，对步骤一所得离散航路点数据进行分段插值拟合处理，得到曲线航迹。