一种基于SINS/DVL组合导航误差标定的方法技术

本发明专利技术涉及基于SINS/DVL组合导航误差标定的方法，步骤为：1)获取航行轨迹预测模型：2)获取DVL航行距离和GNSS航行距离；3)将航次数据纳入总航次数据；重新计算新的待验证DVL误差参数并更新系统误差参数；4)回到步骤2)继续执行，直到阶段航次数达到预设的最大航次数量，标定结束，此时已验证误差参数即为DVL误差参数。本发明专利技术基于SINS/DVL组合导航误差标定的方法，对GNSS位置数据进行有效性判断，利用最小二乘法建立航行轨迹预测模型来提高GNSS位置信息可靠性，并利用DVL航行距离和GNSS航行距离的关系计算DVL误差参数，标定过程中在计算DVL误差的同时加以反馈验证机制，遇到标定错误时能够及时重新计算，验证标定结果正确性，提升标定结果准确度，具有工程实际意义。

An error calibration method based on SINS / DVL integrated navigation

The invention relates to a method for calibrating the integrated navigation error based on SINS / DVL, the steps are: 1) acquiring the navigation trajectory prediction model: 2) acquiring the navigation distance of DVL and GNSS; 3) incorporating the voyage data into the total voyage data; recalculating the new DVL error parameters to be verified and updating the system error parameters; 4) going back to step 2) continuing to execute until the stage voyage number reaches the preset maximum voyage Quantity, end of calibration, at this time the verified error parameter is DVL error parameter. Based on the method of SINS / DVL integrated navigation error calibration, the invention judges the validity of GNSS position data, establishes the navigation trajectory prediction model by using the least square method to improve the reliability of GNSS position information, calculates the error parameter of DVL by using the relationship between the navigation distance of DVL and the navigation distance of GNSS, calculates the error parameter of DVL while the error of DVL is calculated in the calibration process, and provides the feedback verification mechanism when the calibration is encountered In case of error, it can be recalculated in time to verify the correctness of calibration results and improve the accuracy of calibration results, which has practical significance in engineering.

【技术实现步骤摘要】
一种基于SINS/DVL组合导航误差标定的方法
本专利技术涉及导航
，特别是涉及一种基于SINS/DVL组合导航误差标定的方法。
技术介绍
惯导系统具有自主、稳定、短时定位精度高的优势，但长时间工作时存在累计误差，工程中常利用其它导航设备提供的辅助导航信息对惯导误差进行估计和校正的方法来实现高精度导航，DVL(多普勒计程仪)是较精准的外部测速导航设备，SINS(捷联惯性导航系统(StrapdownInertialNavigationSystem)/DVL(多普勒计程仪(DopplerVelocityLog))组合导航就是利用DVL提供的高精度速度来抑制SINS导航误差的积累，而对于组合导航系统来说，解决外部辅助信息和惯导信息的时空一致性是保证组合导航精度的基础。由于DVL本身具有刻度系数误差，其坐标系与载体坐标系也不完全一致，因此在组合导航之前需要对DVL进行标定，目的是为了获取DVL的安装误差和刻度系数误差。目前常用Kalman滤波方程来求解安装误差角和刻度系数误差，但往往方案实现比较复杂，标定过程中也易受到GNSS(全球导航卫星系统)数据可靠性的干扰，导致标定结果不够准确和稳定。本专利技术对GNSS位置数据进行有效性判断，建立有效数据集合，进而利用最小二乘法建立航行轨迹预测模型。在标定过程中利用该模型对GNSS数据信息进行预测和剔除，提高了标定过程中GNSS数据信息的可靠性，同时标定过程中在计算DVL误差时加以反馈验证机制，遇到标定错误时及时发现，验证了标定结果的正确性，提升了标定结果的准确度。r>
技术实现思路
本专利技术的目的在于克服现有技术的不足，提供一种实现简单、准确度高的基于SINS/DVL组合导航误差标定的方法。本专利技术解决其技术问题是通过以下技术方案实现的：一种基于SINS/DVL组合导航误差标定的方法，其特征在于：包括如下步骤：1)获取航行轨迹预测模型：使惯导系统工作在两路通道的导航解算，并同时进行两种通道解算，两种通道为SINS/GNSS组合导航通道和SINS/DVL航位推算通道，当GNSS有效时，使载体沿直线航行一小段时间，对采集的GNSS位置信息进行统计，剔除野值，获取有效的位置集合，再利用最小二乘法对该有效位置集合进行拟合，建立最小二乘预测模型，从而获取航行轨迹预测模型；2)获取DVL航行距离和GNSS航行距离：在标定过程中，按所述航行轨迹预测模型对GNSS位置信息进行预测，剔除GNSS野值数据，得到较为可靠的GNSS位置信息，采用该位置信息进行Kalman滤波解算，使惯导系统误差达到最小，并利用该GNSS位置信息引导载体沿直线进行航行，实时推算DVL航行距离，最终获取DVL航行距离和GNSS航行距离；3)将航次数据纳入总航次数据：保持载体原有航行轨迹继续沿直线航行到下一个阶段航次点时，与上一阶段航次点比较位置精度误差，若精度误差变大，说明上一航次标定无效，则忽略待验证DVL误差参数和上段航次数据，将本段航次数据进行坐标平移后纳入总航次数据；若精度误差变小，则待验证DVL误差参数更新为已验证误差参数，将本段航次数据纳入总航次数据；4)重新计算新的待验证DVL误差参数并更新系统误差参数；5)回到步骤2)继续执行，直到阶段航次数达到预设的最大航次数量，标定结束，此时已验证误差参数即为DVL误差参数。而且，步骤2)的DVL航行距离和GNSS航行距离，根据以下公式计算：Δt为DVL速度采样周期；N为采样点数；为DVL测量速度在m坐标系的分解量；为DVL航行距离在m坐标系的分解量；为GNSS航行距离在b坐标系的分解量；λGNSS(t0)，LGNSS(t0)是整个航次起点的GNSS经纬度；λGNSS(t)，LGNSS(t)是阶段航次结束时的GNSS经纬度；RM，RN是旋转椭球面的主曲率半径。而且，步骤3)的计算待验证DVL误差参数，是指根据以下公式计算DVL安装误差：其中：为DVL航行距离；为GNSS航行距离。本专利技术的优点和有益效果为：1、本专利技术的基于SINS/DVL组合导航误差标定的方法，本专利技术对GNSS位置数据进行有效性判断，利用最小二乘法建立航行轨迹预测模型来提高GNSS位置信息的可靠性，并利用DVL航行距离和GNSS航行距离的关系计算DVL误差参数，标定过程中在计算DVL误差的同时加以反馈验证机制，遇到标定错误时能够及时重新计算，验证了标定结果的正确性，提升了标定结果的准确度，具有工程实际意义。附图说明图1为本专利技术的工作流程图。具体实施方式下面通过具体实施例对本专利技术作进一步详述，以下实施例只是描述性的，不是限定性的，不能以此限定本专利技术的保护范围。一种基于SINS/DVL组合导航误差标定的方法，其理论推导过程为：在SINS/DVL组合导航过程，主要误差源包括DVL的刻度系数误差和载体与DVL之间的安装误差。为了提高DVL的测速精度，需要对DVL安装误差和刻度系数误差进行标定补偿。设DVL载体坐标系为m系，惯导系统载体坐标系为b系，惯导系统导航坐标系为地理坐标系n系，则：若不计惯导姿态误差，DVL速度在导航坐标系中的投影与DVL速度在载体坐标系的投影关系为：为DVL真实速度，为DVL与载体之间的安装误差，为载体坐标系与导航坐标系之间的状态转换矩阵。若设DVL的刻度系数误差为δk，则为DVL测量速度，δk为DVL刻度系数误差。有：转换为：若定义标定过程在水面进行，则垂向速度变化很小，水平误差角对定位影响很小，可以忽略不计，转为二维空间解算，对式1变换，有：其中，为在载体坐标系的分解速度；γ为DVL的方位安装误差角；为在m坐标系的分解速度。由于γ一般很小，近似认为则：理论上，比较难于获得，可以选取替代的方式是利用其它信息源获取的数据作为替代数据，比如GNSS。得：但往往由于GNSS速度不如GNSS位置可靠，有：解得：式2即为DVL的安装误差求解公式，其中,为DVL的实测航行距离，为GNSS的航行距离，并由下式求得：其中，Δt为DVL速度采样周期；为DVL测量速度在二维直角坐标系的分解速度；为DVL的实测航行距离；为GNSS的航行距离；λGNSS(t0)，LGNSS(t0)是整个航次起点的GNSS经度和纬度；λGNSS(t)，LGNSS(t)是阶段航次结束时的GNSS经度和纬度；RM，RN是旋转椭球面的主曲率半径。本专利技术需要借助GNSS实测数据进行DVL安装误差的标定，故在标定过程中需对GNSS数据进行处理，提高位置数据可靠性。假定二维空间上存在点P，在直角坐标系表示为P(x,y),在极坐标系表示为P(ρ,θ)，其中则极坐标方程：ρ＝xcosθ+y本文档来自技高网...

【技术保护点】
1.一种基于SINS/DVL组合导航误差标定的方法，其特征在于：包括如下步骤：/n1)获取航行轨迹预测模型：使惯导系统工作在两路通道的导航解算，并同时进行两种通道解算，两种通道为SINS/GNSS组合导航通道和SINS/DVL航位推算通道，当GNSS有效时，使载体沿直线航行一小段时间，对采集的GNSS位置信息进行统计，剔除野值，获取有效的位置集合，再利用最小二乘法对该有效位置集合进行拟合，建立最小二乘预测模型，从而获取航行轨迹预测模型；/n2)获取DVL航行距离和GNSS航行距离：在标定过程中，按所述航行轨迹预测模型对GNSS位置信息进行预测，剔除GNSS野值数据，得到较为可靠的GNSS位置信息，采用该位置信息进行Kalman滤波解算，使惯导系统误差达到最小，并利用该GNSS位置信息引导载体沿直线进行航行，实时推算DVL航行距离，最终获取DVL航行距离和GNSS航行距离；/n3)将航次数据纳入总航次数据：保持载体原有航行轨迹继续沿直线航行到下一个阶段航次点时，与上一阶段航次点比较位置精度误差，若精度误差变大，说明上一航次标定无效，则忽略待验证DVL误差参数和上段航次数据，将本段航次数据进行坐标平移后纳入总航次数据；若精度误差变小，则待验证DVL误差参数更新为已验证误差参数，将本段航次数据纳入总航次数据；/n4)重新计算新的待验证DVL误差参数并更新系统误差参数；/n5)回到步骤2)继续执行，直到阶段航次数达到预设的最大航次数量，标定结束，此时已验证误差参数即为DVL误差参数。/n...

【技术特征摘要】
1.一种基于SINS/DVL组合导航误差标定的方法，其特征在于：包括如下步骤：
1)获取航行轨迹预测模型：使惯导系统工作在两路通道的导航解算，并同时进行两种通道解算，两种通道为SINS/GNSS组合导航通道和SINS/DVL航位推算通道，当GNSS有效时，使载体沿直线航行一小段时间，对采集的GNSS位置信息进行统计，剔除野值，获取有效的位置集合，再利用最小二乘法对该有效位置集合进行拟合，建立最小二乘预测模型，从而获取航行轨迹预测模型；
2)获取DVL航行距离和GNSS航行距离：在标定过程中，按所述航行轨迹预测模型对GNSS位置信息进行预测，剔除GNSS野值数据，得到较为可靠的GNSS位置信息，采用该位置信息进行Kalman滤波解算，使惯导系统误差达到最小，并利用该GNSS位置信息引导载体沿直线进行航行，实时推算DVL航行距离，最终获取DVL航行距离和GNSS航行距离；
3)将航次数据纳入总航次数据：保持载体原有航行轨迹继续沿直线航行到下一个阶段航次点时，与上一阶段航次点比较位置精度误差，若精度误差变大，说明上一航次标定无效，则忽略待验证DVL误差参数和上段航次数据，将本段航次数据进行坐标平移后纳入总航次数据；若精度误差变小，则待验证DVL误差参数更新为已验证误差参数，将本段航次...

【专利技术属性】
技术研发人员：郭猛，胡小毛，肖永刚，刘赢，
申请(专利权)人：中国船舶重工集团公司第七零七研究所，
类型：发明
国别省市：天津;12