GNSS位置辅助SINS行进间初始对准方法技术

本发明专利技术公开了一种GNSS位置辅助SINS行进间初始对准方法。本发明专利技术公开了一种GNSS位置辅助SINS行进间初始对准方法，解决了GNSS速度法辅助SINS对准过程中量测信息易受GNSS量测异常的影响。本发明专利技术的主要步骤为：步骤一：获取惯性传感器实时数据并进行姿态更新；步骤二：获取GNSS实时位置数据；步骤三：利用获取的GNSS位置信息，建立位置法矢量观测器；步骤四：设计基于迭代原理的矢量观测器；步骤五：利用最优基四元数姿态确定方法，并计算确定姿态与真实姿态之间的误差角；步骤六：初始对准过程运行时间为M，若k＝M，则输出初始对准结果，完成初始对准过程，若k

【技术实现步骤摘要】
GNSS位置辅助SINS行进间初始对准方法
本专利技术涉及捷联惯性导航系统初始对准领域，具体涉及一种GNSS位置辅助SINS行进间初始对准方法。
技术介绍
捷联惯性导航系统初始对准技术是系统正常导航定位的关键技术之一，采用GNSS辅助惯性导航系统进行行进间初始对准具有对准精度高、可靠性好等优点。当前，初始对准可以分为粗对准和精对准两个过程，其中粗对准主要实现粗略的姿态估计；精对准则是在粗对准的基础上进行姿态精估计。众多学者都对捷联惯导系统初始对准技术进行了深入的研究。在精对准方面，通过引入鲁棒卡尔曼滤波技术可以实现对准过程的鲁棒化，提高系统的稳定性。传统技术存在以下技术问题：但在GNSS辅助惯导粗对准方面，当前的研究热点均是采用速度辅助，利用速度积分方程实现行进间初始粗对准，但是由于GNSS易受外部干扰，导致速度测量存在异常现象，这也导致对准结果出现波动或者不收敛，造成对准结果稳定性差的缺点。
技术实现思路
本专利技术要解决的技术问题是提供一种GNSS位置辅助SINS行进间初始对准方法，为克服传统GNSS辅助SINS粗对准方法无法进行鲁棒化粗对准的问题，采用GNSS位置矢量建模方法，利用位置矢量弱化GNSS量测异常问题，可以实现粗对准过程的鲁棒化，提高系统对准的稳定性。为了解决上述技术问题，本专利技术提供了一种GNSS位置辅助SINS行进间初始对准方法，包括：获取惯性传感器实时数据并进行姿态更新，定义解算所需的参考坐标系；获取GNSS实时位置数据：利用获取的GNSS位置信息，建立位置法矢量观测器；设计基于迭代原理的矢量观测器；利用最优基四元数姿态确定方法，并计算确定姿态与真实姿态之间的误差角。在其中一个实施例中，其中，定义解算所需的参考坐标系具体如下：b—载体坐标系，表示捷联惯性导航系统三轴正交坐标系，其x轴、y轴和z轴分别指向载体的右-前-上；n—导航坐标系，表示载体所在位置的地理坐标系，其三轴分别指向当地东向、北向和天向；e—地球坐标系，表示原点在地心，x轴为地心指向本初子午线与赤道交点，z轴为地心指向北极点，y轴与x轴和z轴构成右手坐标系；i—惯性坐标系，表示惯性空间非旋转坐标系；b0—初始载体坐标系，表示惯导系统开机运行时刻的载体坐标系，并在整个对准过程中相对于惯性空间保持静止；n0—初始导航坐标系，表示惯导系统开机运行时刻的导航坐标系，并在整个对准过程中相对于惯性空间保持静止；e0—初始地球坐标系，表示惯导系统开机运行时刻的地球坐标系，并在整个对准过程中相对于惯性空间保持静止；由姿态更新算法可知：式中：表示导航系姿态矩阵微分；表示载体系姿态矩阵微分；表示导航系相对于初始导航系的方向余弦矩阵；表示载体系相对于初始载体系的方向余弦矩阵；表示导航系相对于惯性系的旋转角速度在导航系的映射；表示载体系相对于惯性系的旋转角速度在载体系的映射；利用方向余弦链式法则，可得：式中：表示载体系相对于导航系的实时方向余弦矩阵；表示初始导航系相对于导航系的方向余弦矩阵；表示载体系相对于初始载体系的方向余弦矩阵。在其中一个实施例中，“利用获取的GNSS位置信息，建立位置法矢量观测器；”具体如下：由惯性导航系统比力方程可知：式中：表示导航系速度的微分；表示载体系相对于导航系变化的方向余弦矩阵；fb表示比力；表示地球系相对于惯性系的旋转角速度在导航系的投影；表示导航系相对于地球系的转动角速度在导航系的投影；×表示矢量叉乘运算；vn表示导航系速度；gn表示重力加速度在导航系下的投影；由上面推导可知：式中：表示导航系速度的微分；表示初始导航系相对于导航系的方向余弦矩阵；表示初始载体系相对于初始导航系的方向余弦矩阵；表示载体系相对于初始载体系的方向余弦矩阵；fb表示比力；表示地球系相对于惯性系的旋转角速度在导航系的投影；表示导航系相对于地球系的转动角速度在导航系的投影；×表示矢量叉乘运算；vn表示导航系速度；gn表示重力加速度在导航系下的投影；对上式进行计算可得：式中：βa表示加速度观测矢量；表示初始载体系相对于初始导航系的方向余弦矩阵；αa表示加速度参考矢量；表示导航系相对于初始导航系的方向余弦矩阵；表示导航系速度微分；表示地球系相对于惯性系的旋转角速度在导航系的投影；表示导航系相对于地球系的转动角速度在导航系的投影；×表示矢量叉乘运算；vn表示导航系速度；gn表示重力加速度在导航系下的投影；表示载体系相对于初始载体系的方向余弦矩阵；fb表示比力；根据GNSS位置信息与导航系速度关系可知：式中：表示GNSS位置微分；Rc表示当地曲率矩阵；vn表示导航系速度；表示位置矢量微分；L表示载体当前纬度；RM表示表示子午线曲率半径；RN表示横向曲率半径；h表示载体水平高度；对加速度观测矢量和参考矢量进行两次积分可得：式中：βp表示GNSS位置观测矢量；αp表示GNSS位置参考矢量；表示初始载体系相对于初始导航系的方向余弦矩阵；表示位置矢量微分；表示τ时刻导航系相对于初始导航系的方向余弦矩阵；t表示当前时刻；vn(0)表示初始时刻导航系速度；表示σ时刻导航系相对于初始导航系的方向余弦矩阵；表示地球系相对于惯性系的旋转角速度在导航系的投影；gn表示重力加速度在导航系下的投影；表示σ时刻载体系相对于初始载体系的方向余弦矩阵；fb表示比力。在其中一个实施例中，“设计基于迭代原理的矢量观测器；”具体如下：对上面基于GNSS位置的观测矢量和参考矢量进行积分运算，其中参考矢量可以计算为：式中，αp(M)表示离散化M时刻的参考矢量；ΔtG表示GNSS采样时间；表示tm时刻载体系相对于初始载体系的方向余弦矩阵；表示σ时刻载体系相对于tm时刻载体系的方向余弦矩阵；fb表示比力；其中，积分项可以计算为：式中，表示tm时刻载体系相对于初始载体系的方向余弦矩阵；表示σ时刻载体系相对于tm时刻载体系的方向余弦矩阵；fb表示比力；Δv1表示加速度计输出的一子样；Δv2表示加速度计输出的二子样；Δθ1表示陀螺仪量测角增量的一子样；Δθ2表示陀螺仪量测角增量的二子样；对参考矢量各积分项进行计算：式中：表示位置矢量微分；表示τ时刻导航系相对于初始导航系的方向余弦矩阵；rn表示位置矢量；表示tM时刻导航系相对于初始导航系的方向余弦矩阵；表示tk时刻导航系相对于初始导航系的方向余弦矩阵；表示τ时刻导航系相对于tk时刻导航系的方向余弦矩阵；表示导航系相对于惯性系的旋转角速度在导航系的投影；表示σ时刻导航系相对于初始导航系的方向余弦矩阵；表示地球系相对于惯性系的旋转角速度在导航系的投影；gn表示重力加速度在导航系下的投影；ΔtG表示GNSS采样时间；表示tm时刻导航系相对于初始导航系的方向余弦矩阵；表示σ时刻导航系相对于tm时刻导航系的方向余弦矩阵；表示σ时刻导航系相对于tk时刻导航系的方向余弦矩阵；因此观测矢量可以迭代计算为：式中，βp(M)表示离散化M时刻的观测矢量；表示tM时刻导航系相对于初始导航系的方向余弦矩阵；t表示当前时刻；vn(0)表示初始时刻导航系速度；ΔtG表示GNSS采样时间；表示tm时刻导航系相对于初始导航系的方向余弦矩阵；表示导航系相对于惯性系的旋转角速度在导航系的投影；表示tk时刻导航系相对于初始导航系的方向余弦矩阵；gn表示重力加速度在导航系下的投影；本文档来自技高网...

【技术保护点】
1.一种GNSS位置辅助SINS行进间初始对准方法，其特征在于，包括：获取惯性传感器实时数据并进行姿态更新，定义解算所需的参考坐标系；获取GNSS实时位置数据：利用获取的GNSS位置信息，建立位置法矢量观测器；设计基于迭代原理的矢量观测器；利用最优基四元数姿态确定方法，并计算确定姿态与真实姿态之间的误差角。

【技术特征摘要】
1.一种GNSS位置辅助SINS行进间初始对准方法，其特征在于，包括：获取惯性传感器实时数据并进行姿态更新，定义解算所需的参考坐标系；获取GNSS实时位置数据：利用获取的GNSS位置信息，建立位置法矢量观测器；设计基于迭代原理的矢量观测器；利用最优基四元数姿态确定方法，并计算确定姿态与真实姿态之间的误差角。2.如权利要求1所述的GNSS位置辅助SINS行进间初始对准方法，其特征在于，其中，定义解算所需的参考坐标系具体如下：b—载体坐标系，表示捷联惯性导航系统三轴正交坐标系，其x轴、y轴和z轴分别指向载体的右-前-上；n—导航坐标系，表示载体所在位置的地理坐标系，其三轴分别指向当地东向、北向和天向；e—地球坐标系，表示原点在地心，x轴为地心指向本初子午线与赤道交点，z轴为地心指向北极点，y轴与x轴和z轴构成右手坐标系；i—惯性坐标系，表示惯性空间非旋转坐标系；b0—初始载体坐标系，表示惯导系统开机运行时刻的载体坐标系，并在整个对准过程中相对于惯性空间保持静止；n0—初始导航坐标系，表示惯导系统开机运行时刻的导航坐标系，并在整个对准过程中相对于惯性空间保持静止；e0—初始地球坐标系，表示惯导系统开机运行时刻的地球坐标系，并在整个对准过程中相对于惯性空间保持静止；由姿态更新算法可知：式中：表示导航系姿态矩阵微分；表示载体系姿态矩阵微分；表示导航系相对于初始导航系的方向余弦矩阵；表示载体系相对于初始载体系的方向余弦矩阵；表示导航系相对于惯性系的旋转角速度在导航系的映射；表示载体系相对于惯性系的旋转角速度在载体系的映射；利用方向余弦链式法则，可得：式中：表示载体系相对于导航系的实时方向余弦矩阵；表示初始导航系相对于导航系的方向余弦矩阵；表示载体系相对于初始载体系的方向余弦矩阵。3.如权利要求1所述的GNSS位置辅助SINS行进间初始对准方法，其特征在于，“利用获取的GNSS位置信息，建立位置法矢量观测器；”具体如下：由惯性导航系统比力方程可知：式中：表示导航系速度的微分；表示载体系相对于导航系变化的方向余弦矩阵；fb表示比力；表示地球系相对于惯性系的旋转角速度在导航系的投影；表示导航系相对于地球系的转动角速度在导航系的投影；×表示矢量叉乘运算；vn表示导航系速度；gn表示重力加速度在导航系下的投影；由上面推导可知：式中：表示导航系速度的微分；表示初始导航系相对于导航系的方向余弦矩阵；表示初始载体系相对于初始导航系的方向余弦矩阵；表示载体系相对于初始载体系的方向余弦矩阵；fb表示比力；表示地球系相对于惯性系的旋转角速度在导航系的投影；表示导航系相对于地球系的转动角速度在导航系的投影；×表示矢量叉乘运算；vn表示导航系速度；gn表示重力加速度在导航系下的投影；对上式进行计算可得：式中：βa表示加速度观测矢量；表示初始载体系相对于初始导航系的方向余弦矩阵；αa表示加速度参考矢量；表示导航系相对于初始导航系的方向余弦矩阵；表示导航系速度微分；表示地球系相对于惯性系的旋转角速度在导航系的投影；表示导航系相对于地球系的转动角速度在导航系的投影；×表示矢量叉乘运算；vn表示导航系速度；gn表示重力加速度在导航系下的投影；表示载体系相对于初始载体系的方向余弦矩阵；fb表示比力；根据GNSS位置信息与导航系速度关系可知：式中：表示GNSS位置微分；Rc表示当地曲率矩阵；vn表示导航系速度；表示位置矢量微分；L表示载体当前纬度；RM表示表示子午线曲率半径；RN表示横向曲率半径；h表示载体水平高度；对加速度观测矢量和参考矢量进行两次积分可得：式中：βp表示GNSS位置观测矢量；αp表示GNSS位置参考矢量；表示初始载体系相对于初始导航系的方向余弦矩阵；表示位置矢量微分；表示τ时刻导航系相对于初始导航系的方向余弦矩阵；t表示当前时刻；vn(0)表示初始时刻导航系速度；表示σ时刻导航系相对于初始导航系的方向余...

【专利技术属性】
技术研发人员：徐祥，徐大诚，
申请(专利权)人：苏州大学，
类型：发明
国别省市：江苏,32