专利名称：一种船用惯性导航系统摇摆基座开环对准方法
技术领域：
本发明涉及一种准确、快速、稳定可靠、易于实现的船用惯性导航系统摇摆基座开环对准方法，该方法同样也可用于其它应用场合惯性惯导系统的静基座及摇摆基座初始对准，属于惯性导航领域。
背景技术：
惯性导航系统具有全自主、高隐蔽性、高带宽、连续输出等特点，在国防上具有战略意义，是航空、航天、航海等领域中最重要的设备之一。初始对准是在惯导进入导航状态前确定其初始状态的过程，初始状态包括初始速度、位置、姿态和陀螺漂移。初始对准的误差在整个导航过程中会影响系统的导航性能，其水平是影响惯性导航精度最为主要的因素之一。舰船等应用环境一般需要惯导系统能够在基座摇摆的条件下实现高精度对准，因此必须要求在惯导系统内部建立起隔离载体运动的数学/物理平台。传统的对准办法需要惯导处于导航状态，根据位置误差和速度误差反推平台偏角及陀螺漂移。利用这种方法需要较长的对准时间，且误差模型本身对线性近似较敏感。
发明内容
本发明解决的技术问题是克服现有技术的不足，提供一种船用惯性导航系统摇摆基座开环对准方法，具有准确、快速、稳定可靠、易于实现等特点。本发明的技术解决方案是一种船用惯性导航系统摇摆基座开环对准方法，实现步骤如下(1)输入初始纬度，根据初始纬度计算当地地球自转角速度；(2)利用粗对准得到的姿态矩阵计算地球自转角速度在载体坐标系上的投影，并将载体坐标系上地球自转角速度的投影从陀螺仪输出中扣除，得到载体的相对运动角速度；(3)根据步骤(2)中得到的载体相对运动角速度更新四元数及载体姿态矩阵和姿态；(4)根据步骤(3)中得到载体姿态矩阵将机体坐标系加速度计的输出转换到数学平台坐标系下，得到数学平台坐标系下载体的东向及北向加速度；(5)根据步骤⑷得到的数学平台坐标系下载体的东向及北向加速度，计算东向、 北向数学平台偏角；(6)根据步骤(5)得到的东向、北向数学平台偏角作为量测量，对东向北向数学平台偏角误差方程进行最小二乘拟合，得到平台坐标系下的等效陀螺漂移；(7)根据步骤(6)得到的平台坐标系下的等效陀螺漂移计算转导航时刻的数学平台偏角并进行补偿，利用(3)中计算的载体姿态矩阵，将步骤(6)拟合得到的平台坐标系下的等效陀螺漂移转换到载体坐标系下并进行补偿。
4
本发明的原理是通过建立运动隔离平台，将载体的运动角速度从陀螺输出中扣除，将载体姿态角引起的重力加速度投影从加速度计输出中扣除，从而得到隔离载体运动后的平台坐标系下的加速度及偏角量测；推导此种解算条件下惯导系统误差模型，对偏角量测进行拟合，从而估计出陀螺漂移的平均值和初始平台偏角。本发明与现有技术相比的优点在于(1)传统的船用惯导系统摇摆基座条件下初始对准时需要惯导处于导航状态，利用导航位置和速度误差反推平台偏角和陀螺漂移，因此误差传递过程时间较长，且模型对非线性误差较敏感。本发明利用初始时刻输入的位置作为整个对准过程中的载体位置，舰船摇摆情况下，视其速度为零，在此条件下进行姿态更新，并构建隔离平台，计算平台坐标系下的加速度和平台偏角。推导在以上解算条件下惯导的误差方程，并以平台偏角为量测量，利用最小二乘法估计对准过程中的平均漂移及平台偏角，在转导航时刻予以修正。与传统方法相比，这种方法减少了速度更新和位置更新两个环节，可以极大缩短对准时间和提高对准精度。本发明所指的惯性导航系统摇摆基座开环对准方法具有准确、快速、稳定可靠、易于实现等优点。(2)本发明的对准方法不更新惯导位置和速度，减少了对准量测计算过程，且对非线性误差不敏感；同时还适用于静基座及车载等其它应用环境的惯导系统初始对准，具有一定的通用性。
图1为本发明所指的新对准方法流程示意图；图2为本发明实施例中动基座对准等效北向陀螺漂移估计曲线；图3为本发明实施例中动基座对准等效天向陀螺漂移估计曲线；图4为本发明实施例中动基座对准初始方位平台偏角估计曲线；图5为本发明实施例中对准结束后202小时导航东向位置误差曲线；图6为本发明实施例中对准结束后202小时导航北向位置误差曲线。
具体实施例方式下面以某型激光陀螺惯性导航系统海上试验系泊状态下初始对准过程为例来阐述本发明的具体实施过程。图1为发明所提的新对准方法流程图，具体过程如下1、输入初始纬度，根据初始纬度计算当地地球自转角速度；2、利用粗对准得到的姿态矩阵计算地球自转角速度在载体坐标系上的投影，并将载体坐标系上地球自转角速度的投影从陀螺仪输出中扣除，得到载体的相对运动角速度， 如下式所示
(9) 3、根据步骤(2)中得到的载体相对运动角速度更新四元数及载体姿态矩阵和
"ο _
CObnb =ω\-Cbn①Noybz姿态，四元数更新过程的表达式为
权利要求
1.一种船用惯性导航系统摇摆基座开环对准方法，其特征在于实现步骤如下(1)输入初始纬度，根据初始纬度计算当地地球自转角速度；(2)利用粗对准得到的姿态矩阵计算地球自转角速度在载体坐标系上的投影，并将载体坐标系上地球自转角速度的投影从陀螺仪输出中扣除，得到载体相对运动角速度；(3)根据步骤(2)中得到的载体相对运动角速度更新四元数及载体姿态矩阵和姿态；(4)根据步骤(3)中得到载体姿态矩阵，将机体坐标系加速度计的输出转换到数学平台坐标系下，得到数学平台坐标系下载体的东向及北向加速度；(5)根据步骤(4)得到的数学平台坐标系下载体的东向及北向加速度，计算东向、北向数学平台偏角；(6)根据步骤(5)得到的东向、北向数学平台偏角量测量，对东向北向数学平台偏角的误差方程进行最小二乘拟合，得到平台坐标系下的等效陀螺漂移；(7)根据步骤(6)得到的平台坐标系下的等效陀螺漂移计算转导航时刻的数学平台偏角并进行补偿，利用步骤(3)中计算的载体姿态矩阵，将步骤(6)拟合得到的平台坐标系下的等效陀螺漂移转换到载体坐标系下并进行补偿。
2.根据权利要求1所述的船用惯性导航系统摇摆基座开环对准方法，其特征在于所述步骤(2)的载体相对运动角速度计算公式如下(1)上式(1)中 &为载体相对运动角速度，<，ω"γ, 乂为三个方向陀螺仪的输出角速度，C A为载体的姿态矩阵，(^和ω 分别为当地地球自转角速度的北向和天向分量。
3.根据权利要求1所述的船用惯性导航系统摇摆基座开环对准方法，其特征在于所述步骤(5)中东向、北向数学平台偏角计算如下"ο “
4.根据权利要求1所述的船用惯性导航系统摇摆基座开环对准方法，其特征在于步骤(6)所述的由数学平台偏角利用最小二乘法拟合陀螺漂移的过程如下a.由步骤(1)至(5)计算数学平台偏角时，数学平台偏角的状态方程如下 δ4 = (ΟιΑΦν - ωΝΑΦυ + ^sE( 4 )
全文摘要
一种船用惯性导航系统摇摆基座开环对准方法，是指舰船处于系泊状态时，通过在惯性导航系统内部建立数学平台从而隔离载体角运动，并以惯导的数学平台偏角为量测量，利用递推最小二乘法进行对准与测漂。本发明直接以惯导系统的数学平台偏角为量测量，利用递推最小二乘法进行偏角和漂移估计，可大大简化初始对准过程的计算，具有准确、高效、易于实现、高通用性等特点。
文档编号G01C21/20GK102168978SQ20101060898
公开日2011年8月31日 申请日期2010年12月17日 优先权日2010年12月17日
发明者刘芳, 张璐, 徐烨烽, 李魁 申请人:北京航空航天大学