[发明专利]一种基于SINS与DVL组合的AUV行进间快速初始对准方法

说明书

一种基于SINS与DVL组合的AUV行进间快速初始对准方法，满足AUV在航行过程中快速初始对准的技术要求，能在较短时间内进一步提高对准精度，提升其鲁棒性。通过DVL获取的速度信息修正SINS输出的导航信息，结合逆向导航解算的思想对修正后的信息进行正向与逆向反复交替处理，使导航系统充分利用对准过程中产生的导航信息，提高信息的利用率，从而提升对准精度。从仿真结果看出，在一定时间内增加对准阶段正向与逆向的处理次数，可更快的估出失准角误差，且估计精度提升两倍。在AUV大角度失准角条件下，仍有较高的估计精度和较好的通用性。该方法可用于多AUV的航行编队控制、协同作业、海底地形探测与海图测绘等领域，在理论研究与工程实践方面具有指导和应用价值。

技术领域

本发明属于自主水下航行器(AUV)的初始对准方法，涉及一种基于捷联惯导系统与多普勒速度仪组合的AUV行进间快速初始对准方法。

背景技术

在水下导航领域，应用比较成熟的是捷联惯性导航系统(SINS)与多普勒速度仪(DVL)组合导航系统。通过DVL实时提供的高精度速度信息，抑制SINS位置误差的发散，具有自主性与定位精度高的特点，因此广泛运用于AUV水下导航。惯导系统在正式进入导航任务前，需要完成初始对准，且初始对准的两个重要指标是精确性和快速性，惯导系统的对准精度直接影响着AUV的导航精度，而对准的快速性决定了AUV的是否能够快速投入使用，而这两者之间往往是互相矛盾的。

传统的岸上静基座初始对准虽然不需要外部提供航行器的运动信息，能够直接实现对惯导系统的补偿与修正，但需要较长的对准时间，会在很大程度上降低AUV的机动能力，限制其使用范围。因此在一些任务场景下，当要求AUV能够快速响应且快速集结投入使用时，则不再适用。因此，研究一种能够快速估计失准角误差的对准方法在AUV工程应用领域具有十分重要的意义。不同与岸上静基座对准，AUV航行过程中的行进间对准需要引入外部量测信息辅助完成初始对准。由于DVL为自主测速设备，能够直接测量出AUV在航行过程中的速度信息，且其自主性强、精度高，满足在水下和在一定速度范围内的使用要求。

通常AUV的初始对准采用正向导航解算方法进行处理，这种方式需要利用较多的导航数据进行误差估计，估计时间较长，且估计精度不高。因此针对上述问题，提出一种正向与逆向结合的处理方法。通过对AUV在对准阶段导航系统内部陀螺仪与加速计产生的导航信息进行存储，然后对该信息反复进行正向与逆向的导航解算，通过这种方式可以充分利用在对准阶段产生的导航数据，使得系统可以在较短的时间内利用较少的导航数据进行初始对准，并得到较高的估计精度。最终利用仿真设计了一条模拟AUV水下执行海底地形测绘任务的航行轨迹，并对航行开始前一段时间进行对准角误差估计，通过在不同对准时间的估计误差，对常规的对准方法与该发明提出的对准方法进行对比分析，验证了该方法的可行性与有效性。此外，通过仿真还验证了在大角度失准角条件下，采用该方法仍能快速准确估计出系统的失准角误差，由此证明了该方法的通用性。

发明内容

本发明的技术解决问题是：克服现有技术的不足，提供了一种基于逆向解算的领航AUV导航数据后处理方法，解决了载波跟踪环动态性能与低噪声的矛盾问题。

本发明的技术解决方案是：

一种基于捷联惯导系统与多普勒速度仪组合的AUV行进间快速初始对准方法，步骤如下：

步骤1：建立SINS与DVL的数学模型，包括：

(1.1)建立SINS的状态方程；

(1.2)建立SINS的误差微分方程；

(1.3)建立DVL的误差模型；

(1.4)建立SINS/DVL的量测方程；

步骤2：根据步骤1建立的SINS与DVL的数学模型，建立SINS/DVL的微分更新方程，包括：

(2.1)建立姿态微分更新方程；