[发明专利]一种基于自适应EKF的无人侦察机同步定位与构图方法

说明书

技术领域

本发明属于无人机技术领域，具体涉及一种基于自适应EKF的无人侦察机同步定位与构图方法。

背景技术

现代战争中，战场环境复杂，及时掌握战场情况对取得战争胜利起着决定性的作用。无人侦察机应运而生，其能够潜入敌区上空进行侦查，为作战指挥中心提供实时的敌区图像和信息，使得指挥官及时掌握敌军情况，进而制定合理的作战计划。其中，小型无人侦查机以其体积小、重量轻、造价低、无伤亡等优势已经成为目前研究的热点。无人侦察机在执行任务过程中要求其具有续航时间长、导航精度高、不易被敌方发现等特性。其中高精度的导航是无人侦察机成功完成任何任务的基本前提，因而恰当的导航方法是无人侦察机完成任务成败的关键所在。

导航是指无人侦察机机借助外部信号或通过自身携带的传感器判断自身位置，从而指导其航行、完成预定任务的过程。目前无人侦察机的导航方法主要分为两种，非自主导航以及自主导航。

非自主导航方法主要是卫星导航，利用GPS、欧米茄、罗兰、北斗等，能够获得位置、速度、时间等导航信息，且精度不随时间推移而降低。然而GPS无法提供无人侦察机的姿态信息，此外，目前只有GPS是覆盖全球的，这就使得无人侦察机在执行大范围任务时难免受制于人，并且应用环境的适应性较差，容易受到干扰。自主导航不依赖外界信号源，仅仅通过自身携带的速度、姿态及环境感知传感器即可实现相对准确的导航，但是对于导航算法的要求较高，是目前无人侦察机导航领域的研究重点及难点。

自主导航方法主要有航位推算、视觉导航、地球物理导航、多普勒导航、惯性导航、同步定位与构图等。航位推算具有较强的自主性、保密性及抗干扰性，但是其推算误差随着时间迅速积累，不适合长航时无人侦察机导航；视觉导航具有独立性、准确性，但是只能获得相对的运动状态信息；地球物理导航具有无源性、无辐射、隐蔽性强，但是需要大量的地磁数据，实时性受计算机处理能力限制，且受地形，天气影响；多普勒导航自主性好、测速精度高、抗干扰性强，但是其工作时必须发射电波，隐蔽性不好；惯性导航，精度高、隐蔽性好，短期内具有很高的导航定位精度，但惯导系统初始对准较为困难，且造价比较高。

同步定位与地图构建(SimultaneousLocalizationandMapping，SLAM)技术的提出，一定程度上缓解了上述导航方法中存在的不足。SLAM是在无人侦察机自身位置不确定，航位推算的过程中位置误差逐渐累积的情况下，利用自身携带的环境感知传感器反复探测环境中特征，从而完成自身及特征位置的校正，同时构建环境地图，无需预知地形信息或外部辅助定位设备即可以得到较为可靠的无人侦察机位置信息及环境地图信息，详细描述如图1所示。

发明内容

(一)要解决的技术问题

本发明要解决的技术问题是：如何将自适应滤波方法与SLAM方法相结合以解决无人侦查机自主导航过程中存在的位置误差累计、环境适应性差、初始对准困难及隐蔽性差等问题。

(二)技术方案

为解决上述技术问题，本发明提供一种基于自适应EKF的无人侦察机同步定位与构图方法，该方法包括如下步骤：

步骤S1：对无人侦察机SLAM系统建模；

1.1地图模型

采用特征地图来构建环境地图模型，将环境中的目标用几何原型来描述；

1.2坐标系统