一种摇摆基座条件下惯导系统粗对准方法技术方案

一种摇摆基座条件下惯导系统粗对准方法，包括如下步骤：步骤一：计算载体所在位置地球坐标系相对导航坐标系的旋转矩阵；步骤二：计算载体所在位置地心惯性系对地球坐标系的旋转矩阵；步骤三：计算载体坐标系对载体惯性系的旋转矩阵；步骤四：计算载体惯性系对地心惯性系的旋转矩阵；步骤五：计算载体坐标系相对导航坐标系的姿态矩阵；步骤六：重新选定对准时刻，重复执行步骤四～步骤五，得到

A method of coarse alignment of inertial navigation system under the condition of rocking base

A swing base under the condition of sins coarse alignment method, which comprises the following steps: step one: the rotation matrix calculation carrier position earth coordinate system relative navigation coordinate system; step two: calculate the carrier position from the inertial system of coordinates of the earth rotation matrix; step three: calculate the carrier coordinates of vector rotation matrix inertial system; step four: calculate the vector rotation matrix of the inertial inertial coordinate system; step five: the attitude matrix calculation carrier coordinates relative navigation coordinate system; step six: select the alignment time, repeat step four to step five, get

【技术实现步骤摘要】
一种摇摆基座条件下惯导系统粗对准方法
本专利技术涉及导航领域，具体涉及一种摇摆基座条件下惯导系统粗对准方法。
技术介绍
初始对准是惯性导航系统在正式工作之前的重要准备工作，而粗对准又是初始对准的关键,具有广阔的应用前景。从理论上来说，对准速度是是粗对准最为重要的指标之一，粗对准的时间直接影响初始对准性能的优劣。因此，在现有的条件下，考虑加速度计的刻度系数误差、安装误差角和其他干扰加速度，对捷联惯导系统的摇摆基座粗对准进行优化，使粗对准的时间达到最优，是粗对准方向需要深入研究的课题。目前针对粗对准多采取构造重力加速度来构造辅助矢量，推导载体惯性系对地心惯性系的旋转矩阵，然而这样推导出载体惯性系对地心惯性系的旋转矩阵的误差会比较大。
技术实现思路
本专利技术的目的在于提供一种在摇摆基座条件下惯导系统粗对准更快速的摇摆基座条件下惯导系统粗对准方法。本专利技术的目的是这样实现的，包括如下步骤：步骤一：利用卫星导航系统获取载体所在位置的经度和纬度；计算载体所在位置地球坐标系相对导航坐标系的旋转矩阵计算表达式为式中，L为载体所在位置的纬度；步骤二：计算载体所在位置地心惯性系对地球坐标系的旋转矩阵计算表达式为式中，ωie为地球自转角速度，Δt为距对准起始时刻的时间间隔；步骤三：实时采集惯导系统陀螺仪和加速度计的输出和进行惯导解算，并根据四元数和四阶龙格库塔法计算载体坐标系对载体惯性系的旋转矩阵步骤四：选定两个对准时刻利用惯导系统中陀螺仪的输出以及加速度计的输出和步骤三中得到的计算载体惯性系对地心惯性系的旋转矩阵计算表达式为式中，Δtk为对准时刻与对准开始时刻的时间间隔；g为当地重力加速度；步骤五：计算载体坐标系相对导航坐标系的姿态矩阵计算表达式为；步骤六：重新选定对准时刻，重复执行步骤四～步骤五，得到步骤七：结合欧拉角公式对步骤五和步骤六中得到的求取姿态角，并计算姿态角均值；步骤八：结合欧拉角公式通过姿态角均值计算姿态修正矩阵Tbn；步骤九：利用姿态修正矩阵修正惯导系统的导航姿态矩阵T，得到粗对准后的惯导系统导航姿态矩阵TT，表达式为步骤十：重复执行步骤二～步骤九，实现惯导系统粗对准。进一步的，所述的对准时刻和间隔大于等于30s本专利技术具有如下有益效果：一、本专利技术步骤四中利用了两次速度矢量进行粗对准，在加速度计存在刻度系数误差、安装误差角和其他干扰加速度条件下，均能实现精确对准，具有更高的实用价值；二、本专利技术方法通过采用一段时间内载体惯性系相对地心惯性系的姿态角均值和姿态矩阵最优正交化方法提高了对准精度。附图说明图1为本专利技术的流程图。具体实施方式下面结合图1对本专利技术做更详细的描述：步骤一：确定地球坐标系对导航坐标系的旋转矩阵根据载体的位置可得：L为载体所在位置的纬度。步骤二：计算地心惯性系对地球坐标系的旋转矩阵ωie为地球自传角速度，Δt＝t-t0为距对准起始刻时的时间间隔。步骤三：计算载体坐标系对载体惯性系的旋转矩阵通过陀螺仪测出根据四元数和四阶龙格库塔法求出每一时刻的步骤四：计算载体惯性系对地心惯性系的旋转矩阵在摇摆基座上，加速度计的输出在坐标系ib0上的投影式中δKA、δA分别为加速度计的刻度系数误差和安装误差角，为捷联惯导质心相对载体浮心存在杆臂r所产生的杆臂干扰加速度，为载体垂荡、纵荡、横荡及振动产生的干扰加速度，加速度计零偏。对(3)在[t0,tk]内积分并记：由于gn＝[00-g]T(9)所以式中，Δtk＝tk-t0。步骤五：多次求取姿态矩阵，计算姿态角后求平均，然后根据姿态角反求姿态矩阵，最后求出失准角。具体如下，例如：1.在50s到300s内取值，当分别为50s，60s,70s时，求取出向量Vi(tk1)，Vib0(tk1)的值，然后取在100s到300s内取值,每间隔十秒取只一次，分别求出Vi(tk2)，Vib0(tk2)的值，即根据(13)式可求出21*3个2.然后接着取80s,求取出向量Vi(tk1)，Vib0(tk1)的值,间隔大于等于30s秒，取为110s到300s,每间隔十秒取只一次，分别求出Vi(tk2)，Vib0(tk2)的值，即根据(13)式可求出20个3.以此递推，当时，求取出向量Vi(tk1)，Vib0(tk1)的值，然后取为300s,每间隔十秒取只一次，分别求出Vi(tk2)，Vib0(tk2)的值，即根据(13)式可求出1个步骤六：进行载体坐标系对导航坐标系姿态矩阵的更新；步骤七：一共求出21*3+20+........+1＝273个即求出273个即273个姿态角，对其求取平均值，等到平均的姿态角。步骤八：同通过得到的姿态角，求与之对应的姿态矩阵，再根据求出失准角。步骤九：重复步骤二到步骤八。本文档来自技高网...

【技术保护点】
一种摇摆基座条件下惯导系统粗对准方法，其特征在于，包括如下步骤：步骤一：利用卫星导航系统获取载体所在位置的经度和纬度；计算载体所在位置地球坐标系相对导航坐标系的旋转矩阵

【技术特征摘要】
1.一种摇摆基座条件下惯导系统粗对准方法，其特征在于，包括如下步骤：步骤一：利用卫星导航系统获取载体所在位置的经度和纬度；计算载体所在位置地球坐标系相对导航坐标系的旋转矩阵计算表达式为式中，L为载体所在位置的纬度；步骤二：计算载体所在位置地心惯性系对地球坐标系的旋转矩阵计算表达式为式中，ωie为地球自转角速度，Δt为距对准起始时刻的时间间隔；步骤三：实时采集惯导系统陀螺仪和加速度计的输出和进行惯导解算，并根据四元数和四阶龙格库塔法计算载体坐标系对载体惯性系的旋转矩阵步骤四：选定两个对准时刻利用惯导系统中陀螺仪的输出以及加速度计的输出和步骤三中得到的计算载体惯性系对地心惯性系的旋转矩阵计算表达式为

【专利技术属性】
技术研发人员：徐博，张娇，王星，薛冰，王连钊，李盛新，李珊珊，王潇雨，刘斌，金坤明，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23