CN105973268B - 一种基于共基座安装的传递对准精度定量评估方法 - Google Patents

一种基于共基座安装的传递对准精度定量评估方法 Download PDF

Info

Publication number
CN105973268B
CN105973268B CN201610293287.0A CN201610293287A CN105973268B CN 105973268 B CN105973268 B CN 105973268B CN 201610293287 A CN201610293287 A CN 201610293287A CN 105973268 B CN105973268 B CN 105973268B
Authority
CN
China
Prior art keywords
inertial navigation
sub
main
main inertial
coordinate system
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201610293287.0A
Other languages
English (en)
Other versions
CN105973268A (zh
Inventor
程建华
陈岱岱
费再慧
于天琦
董楠楠
蒋国桉
董铭涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Engineering University
Original Assignee
Harbin Engineering University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201610293287.0A priority Critical patent/CN105973268B/zh
Publication of CN105973268A publication Critical patent/CN105973268A/zh
Application granted granted Critical
Publication of CN105973268B publication Critical patent/CN105973268B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Abstract

本发明属于惯导系统性能评估领域,具体涉及一种针对捷联惯导系统传递对准精度的基于共基座安装的传递对准精度定量评估方法。本发明包括:将子、主惯导共基座安装于同一铝板,构建子、主惯导间方位安装失准角;将安装有子、主惯导的铝板置于高精度转台,利用光学瞄准镜使主惯导的y轴指向正北,利用激光跟踪仪测定子、主惯导y轴指向间的方位安装误差角,作为方位安装误差角基准值;主惯导开机并完成自对准。该方法获取对准精度评估的基准在传递对准之前,通过基准值和估计值的对比即可实现对准精度的定量评估。避免了对准完成后子惯导进行导航解算和平滑解算,大大降低了计算复杂度和数据存储需求;可以实现短时间内多次的重复试验。

Description

一种基于共基座安装的传递对准精度定量评估方法
技术领域
本发明属于惯导系统性能评估领域,具体涉及一种针对捷联惯导系统传递对准精度的基于共基座安装的传递对准精度定量评估方法。
背景技术
传递对准技术,利用高精度惯导系统作为主惯导可以快速实现中、低精度惯导系统的初始对准。传递对准的精度评估可以有效评估各中传递对准方案的精度,用于传递对准方案的评优和优化改进。
典型的传递对准精度评估方法,通常使传递对准结束后的惯导系统进行导航解算,通过观测导航误差对对准结束时刻的残留失准角进行平滑估计(典型文献参见于:陈岱岱.《舰载武器传递对准及其精度评估方法研究》.哈尔滨工程大学硕士学位论文.2013)。这种方法需要进行长时间的惯导解算,并同步存储惯导解算数据以及卡尔曼滤波的四个矩阵,再进行贝叶斯平滑解算,最终平滑估计得到导航解算初始时刻的初始误差值,即为对准结束时刻的对准误差。这类算法存在的不足是:(1)涉及大量的数据存储和计算;(2)受外部基准信息可靠性的影响较大,对于极区等卫星导航系统覆盖较弱的区域适用性差;(3)方位失准角的评估能力较差,实现方位失准角的有效评估依赖于载体的主动机动,对于大型舰船等机动性能较差的载体,甚至有可能会出现无法精确评估方位失准角的情况。
发明内容
本发明的目的在于提供一种计算量更小、适用范围广且能够有效定量评估传递对准方位失准角的基于共基座安装的传递对准精度定量评估方法。
本发明的目的是这样实现的:
(1)将子、主惯导共基座安装于同一铝板,构建子、主惯导间方位安装失准角;
(2)将安装有子、主惯导的铝板置于高精度转台,利用光学瞄准镜使主惯导的y轴指向正北,利用激光跟踪仪测定子、主惯导y轴指向间的方位安装误差角,作为方位安装误差角基准值;
(3)主惯导开机并完成自对准,进入导航状态;
(4)子惯导开机;
(5)主惯导向子惯导传递位置、速度、姿态矩阵;
(6)子惯导进行导航解算,同步采集子、主惯导的速度、姿态信息;
(7)利用卡尔曼滤波进行“速度+姿态”匹配快速传递对准解算,估计出子惯导系统误差状态;
所涉及的子惯导系统误差状态向量为:
式中,φmxmymz为主惯导系到计算得到的子惯导坐标系之间的相对姿态误差;δVx,δVy为子惯导速度误差;φaxayaz为主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差;为子惯导三个轴向的加速度计常值零偏;εxyz为子惯导三个轴向的陀螺常值漂移;
所涉及的快速传递对准系统误差方程为:
式中,φm=[φmxmymz]Ta=[φaxayaz]T,δV=[δVx,δVy]Ts=[εxyz]T为主惯导坐标系m相对东北天地理坐标系n的旋转角速度在子惯导坐标系s下的投影;为子惯导计算坐标系转换至东北天地理坐标系n的转换矩阵;为主惯导比力在子惯导系的投影;为地球自转角速度;为东北天地理坐标系相对于地球系的旋转角速度;
(8)滤波结束后,存储主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差φaxayaz,其中φaz作为方位安装误差角估计值;
(9)通过对比步骤(2)中测得的方位安装误差角基准值与步骤(8)中得到的方位安装误差角估计值,实现传递对准定量精度评估。
所述步骤(7)中的卡尔曼滤波器为非线性滤波器,实现大方位失准角传递对准的精度评估。
本发明的有益效果在于:
该方法获取对准精度评估的基准在传递对准之前,仅需在完成对准后,通过基准值和估计值的对比即可实现对准精度的定量评估。避免了对准完成后子惯导进行导航解算和平滑解算,大大降低了计算复杂度和数据存储需求;可以实现短时间内多次的重复试验;高精度激光跟踪仪能够精确测定子、主惯导方位安装误差角的基准值,精度可达角秒级别,比子、主惯导系统测姿精度(角分)高一个数量级;将子、主惯导系统近距离共基座安装,可有效避免动态挠曲变形对方位精度评估效果的影响;对方位安装误差角的评估尤其精确,适用于大方位失准角条件下的传递对准精度评估;该方法实现的是子、主惯导相对安装误差的评估,适用于极区(高维度地区、南极、北极)传递对准的精度评估,而不需要将导航坐标系转换到极区导航坐标系。
附图说明
图1为本发明提出的方法基本流程框图;
图2为子、主惯导共基座安装俯视图。
具体实施方式
下面结合附图对本发明作进一步的详细描述。
本发明公开了一种基于共基座安装的传递对准精度定量评估方法。通过将传递对准涉及的子、主惯导近距离、共基座安装于同一铝板上,构造子、主惯导间的方位安装误差角。然后,利用激光跟踪仪,测定该方位安装误差角,作为传递对准的方位安装误差角基准值。子、主惯导进行快速传递对准,保存对准结束时刻由卡尔曼滤波器估计得到的子、主惯导方位安装误差角。通过方位安装误差角基准值与估计值的对比,实现对子惯导传递对准的精度评估。该方法可以直接、定量地实现对子惯导传递对准方位安装误差角的精度评估,且不需要进行对准后的惯导解算,计算量小。
实施例一:
本发明的实现包括以下步骤:
(1)将子、主惯导共基座安装于同一铝板,构建子、主惯导间方位安装失准角,使方位安装失准角小于等于3度;
(2)将安装有子、主惯导的铝板置于高精度转台,利用光学瞄准镜使主惯导的y轴向指向正北,利用激光跟踪仪测定子、主惯导y轴指向间的方位安装误差角,作为方位安装误差角基准值;
(3)主惯导开机并完成自对准,进入导航状态;
(4)子惯导开机;
(5)主惯导向子惯导传递位置、速度、姿态矩阵;
(6)子惯导进行导航解算,同步采集子、主惯导的速度、姿态信息;
(7)利用卡尔曼滤波进行“速度+姿态”匹配快速传递对准解算,估计出子惯导系统误差状态;
所涉及的子惯导系统误差状态向量为:
式中,φmxmymz为主惯导系到计算得到的子惯导坐标系之间的相对姿态误差;δVx,δVy为子惯导速度误差;φaxayaz为主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差;为子惯导三个轴向的加速度计常值零偏;εxyz为子惯导三个轴向的陀螺常值漂移;
所涉及的快速传递对准系统误差方程为:
式中,φm=[φmxmymz]Ta=[φaxayaz]T,δV=[δVx,δVy]Ts=[εxyz]T为主惯导坐标系m相对东北天地理坐标系n的旋转角速度在子惯导坐标系s下的投影;为子惯导计算坐标系转换至东北天地理坐标系n的转换矩阵;为主惯导比力在子惯导系的投影;为地球自转角速度;为东北天地理坐标系相对于地球系的旋转角速度;
(8)滤波结束后,存储主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差φaxayaz,其中φaz作为方位安装误差角估计值;
(9)通过对比步骤(2)中测得的方位安装误差角基准值与步骤(8)中得到的方位安装误差角估计值,实现传递对准定量精度评估。
实施例二:
本发明的实现包括以下步骤:
(1)将子、主惯导共基座安装于同一铝板,构建子、主惯导间方位安装失准角,使方位安装失准角大于3度;
(2)将安装有子、主惯导的铝板置于高精度转台,利用光学瞄准镜使主惯导的y轴指向正北,利用激光跟踪仪测定子、主惯导y轴指向间的方位安装误差角,作为方位安装误差角基准值;
(3)主惯导开机并完成自对准,进入导航状态;
(4)子惯导开机;
(5)主惯导向子惯导传递位置、速度、姿态矩阵;
(6)子惯导进行导航解算,同步采集子、主惯导的速度、姿态信息;
(7)利用非线性卡尔曼滤波进行“速度+姿态”匹配快速传递对准解算,估计出子惯导系统误差状态;
所涉及的子惯导系统误差状态向量为:
式中,φmxmymz为主惯导系到计算得到的子惯导坐标系之间的相对姿态误差;δVx,δVy为子惯导速度误差;φaxayaz为主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差;为子惯导三个轴向的加速度计常值零偏;εxyz为子惯导三个轴向的陀螺常值漂移;
所涉及的快速传递对准系统误差方程为:
式中,φm=[φmxmymz]Ta=[φaxayaz]T,δV=[δVx,δVy]Ts=[εxyz]T为主惯导坐标系m相对东北天地理坐标系n的旋转角速度在子惯导坐标系s下的投影;为子惯导计算坐标系转换至东北天地理坐标系n的转换矩阵;为主惯导比力在子惯导系的投影;为地球自转角速度;为东北天地理坐标系相对于地球系的旋转角速度;
(8)滤波结束后,存储主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差φaxayaz,其中φaz作为方位安装误差角估计值;
(9)通过对比步骤(2)中测得的方位安装误差角基准值与步骤(8)中得到的方位安装误差角估计值,实现传递对准定量精度评估。
如附图1所示,该方法的实施流程如下:
(1)将子、主惯导共基座安装于同一铝板,构建子、主惯导间方位安装失准角。对铝板、子惯导底座和主惯导底座的高精度表面加工,有效保证铝板作为基准面,进而忽略子、主惯导的水平安装误差角的干扰。
子、主惯导间方位安装误差角,以子、主惯导壳体的水平y轴指向作为方位指向进行构造。子、主惯导安装误差角俯视图,如图2所示。方位安装误差角值大小将决定后续进行的传递对准问题是否为大方位失准角,进而决定了传递对准的线性及非线性特性。
通常当子、主惯导的方位安装误差角小于等于3度时,认为系统仍满足小角度近似条件,快速传递对准系统误差方程中的反对称阵为
利用上述模型,进行标准卡尔曼滤波解算。
当子、主惯导的方位安装误差角大于3度时,小角度近似时误差较大故不再满足,快速传递对准系统误差方程中的反对称阵为
此时,系统模型表现为非线性特性,数字处理滤波器优选为扩展卡尔曼滤波器、无极卡尔曼滤波器等非线性卡尔曼滤波器。
(2)将安装有子、主惯导的铝板置于高精度转台,利用高精度光学测量设备使主惯导的y轴指向正北,利用激光跟踪仪测定子、主惯导y轴之间的方位安装误差角,作为方位安装误差角基准值。
现有的光学测量设备具有极高的测角精度,激光经纬仪的测姿精度达到数角分,激光全站仪的测姿精度达到数角秒,激光跟踪仪的测姿精度最高达到2角秒。将测量方位安装误差角的光学测量设备优选为激光跟踪仪,其精度确保方位安装误差角测量值作为基准值的有效性。
(3)主惯导开机并完成自对准,自对准时长通常持续约1小时,中等精度激光惯导系统在完成自对准过程后,输出水平姿态精度优于0.02度,方位姿态优于0.1度。在进入导航状态后,输出主惯导解算得到的速度、姿态、位置信息。
(4)子惯导信号输入串口与主惯导信号输出串口相连,子惯导开机、预热,;
(5)传递对准开始时刻,主惯导向子惯导一次性传递主惯导的位置、速度、姿态矩阵;
(6)子惯导利用主惯导传递而来的位置、速度、姿态矩阵作为初始值,完成子惯导导航初始化,子惯导进行导航解算,同步采集子、主惯导的速度、姿态信息;
(7)利用非线性卡尔曼滤波进行“速度+姿态”匹配快速传递对准解算,估计出子惯导系统误差状态;
所涉及的子惯导系统误差状态向量为:
式中,φmxmymz为主惯导系到计算得到的子惯导坐标系之间的相对姿态误差;δVx,δVy为子惯导速度误差;φaxayaz为主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差,为精度评估提供被评估的量;为子惯导三个轴向的加速度计常值零偏;εxyz为子惯导三个轴向的陀螺常值漂移;
所涉及的快速传递对准系统误差方程为:
式中,φm=[φmxmymz]Ta=[φaxayaz]T,δV=[δVx,δVy]Ts=[εxyz]T为主惯导坐标系m相对东北天地理坐标系n的旋转角速度在子惯导坐标系s下的投影;为子惯导计算坐标系转换至东北天地理坐标系n的转换矩阵;为主惯导比力在子惯导系的投影;为地球自转角速度;为东北天地理坐标系相对于地球系的旋转角速度;
对于初始方位安装误差角小于等于3度时,利用标准卡尔曼滤波进行解算;
对于初始方位安装误差角大于3度时,利用非线性卡尔曼滤波器进行解算。优选为无迹卡尔曼滤波器。
(8)滤波结束后,存储主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差φaxayaz,其中φaz作为方位安装误差角估计值;
(9)通过对比步骤(2)中测得的方位安装误差角基准值与步骤(8)中得到的方位安装误差角估计值,实现传递对准定量精度评估。
应理解,这些实施例仅用于说明本发明而不用于限制本发明的范围。此外应理解,在阅读了本发明讲授的内容之后,本领域技术人员可以对本发明作各种改动或修改,这些等价形式同样落于本申请所附权利要求书所限定的范围。

Claims (2)

1.一种基于共基座安装的传递对准精度定量评估方法,其特征在于,包括如下步骤:
(1)将子、主惯导共基座安装于同一铝板,构建子、主惯导间方位安装失准角;
(2)将安装有子、主惯导的铝板置于高精度转台,利用光学瞄准镜使主惯导的y轴指向正北,利用激光跟踪仪测定子、主惯导y轴指向间的方位安装误差角,作为方位安装误差角基准值;
(3)主惯导开机并完成自对准,进入导航状态;
(4)子惯导开机;
(5)主惯导向子惯导传递位置、速度、姿态矩阵;
(6)子惯导进行导航解算,同步采集子、主惯导的速度、姿态信息;
(7)利用卡尔曼滤波进行“速度+姿态”匹配快速传递对准解算,估计出子惯导系统误差状态;
所涉及的子惯导系统误差状态向量为:
式中,φmxmymz为主惯导系到计算得到的子惯导坐标系之间的相对姿态误差;δVx,δVy为子惯导速度误差;φaxayaz为主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差;为子惯导三个轴向的加速度计常值零偏;εxyz为子惯导三个轴向的陀螺常值漂移;
所涉及的快速传递对准系统误差方程为:
式中,φm=[φmxmymz]Ta=[φaxayaz]T,δV=[δVx,δVy]Ts=[εxyz]T为主惯导坐标系m相对东北天地理坐标系n的旋转角速度在子惯导坐标系s下的投影;为子惯导计算坐标系转换至东北天地理坐标系n的转换矩阵;为主惯导比力在子惯导系的投影;为地球自转角速度;为东北天地理坐标系相对于地球系的旋转角速度;
当子、主惯导的方位安装误差角小于等于3度时,快速传递对准系统误差方程中的反对称阵为
利用上述模型,进行标准卡尔曼滤波解算;
当子、主惯导的方位安装误差角大于3度时,快速传递对准系统误差方程中的反对称阵为:
系统模型表现为非线性特性,数字处理滤波器为非线性卡尔曼滤波器;
(8)滤波结束后,存储主惯导载体坐标系到实际的子惯导载体坐标系的相对姿态误差φaxayaz,其中φaz作为方位安装误差角估计值;
(9)通过对比步骤(2)中测得的方位安装误差角基准值与步骤(8)中得到的方位安装误差角估计值,实现传递对准定量精度评估。
2.根据权利要求1所述的一种基于共基座安装的传递对准精度定量评估方法,其特征在于:所述步骤(7)中的卡尔曼滤波器为非线性滤波器,实现大方位失准角传递对准的精度评估。
CN201610293287.0A 2016-05-06 2016-05-06 一种基于共基座安装的传递对准精度定量评估方法 Active CN105973268B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610293287.0A CN105973268B (zh) 2016-05-06 2016-05-06 一种基于共基座安装的传递对准精度定量评估方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610293287.0A CN105973268B (zh) 2016-05-06 2016-05-06 一种基于共基座安装的传递对准精度定量评估方法

Publications (2)

Publication Number Publication Date
CN105973268A CN105973268A (zh) 2016-09-28
CN105973268B true CN105973268B (zh) 2019-09-27

Family

ID=56992644

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610293287.0A Active CN105973268B (zh) 2016-05-06 2016-05-06 一种基于共基座安装的传递对准精度定量评估方法

Country Status (1)

Country Link
CN (1) CN105973268B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106643806B (zh) * 2016-12-30 2019-09-06 深圳友铂科技有限公司 一种惯导系统对准精度评估方法
CN107806874B (zh) * 2017-10-23 2019-01-15 西北工业大学 一种视觉辅助的捷联惯导极区初始对准方法
CN107990910B (zh) * 2017-11-06 2020-09-11 哈尔滨工业大学 一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法
CN108731702B (zh) * 2018-07-03 2021-12-24 哈尔滨工业大学 一种基于Huber方法的大失准角传递对准方法
CN108759870B (zh) * 2018-07-03 2022-03-25 哈尔滨工业大学 一种基于新型鲁棒广义高阶容积卡尔曼滤波的传递对准方法
CN108981696B (zh) * 2018-08-01 2022-02-18 西北工业大学 一种sins任意失准角无奇异快速传递对准方法
CN109460075B (zh) * 2018-11-01 2021-10-01 湖北航天技术研究院总体设计所 一种快速方位角对准的方法及系统
CN109764752B (zh) * 2018-12-20 2021-07-13 北京恒星箭翔科技有限公司 一种单兵制导火箭降低加工精度要求的快速初始对准方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8515672B1 (en) * 2012-03-01 2013-08-20 Honeywell International Inc. Systems and methods to incorporate master navigation system resets during transfer alignment
CN103256942A (zh) * 2013-04-26 2013-08-21 哈尔滨工程大学 传递对准中考虑杆臂补偿的变形角测量方法
CN103471614A (zh) * 2013-08-26 2013-12-25 哈尔滨工程大学 一种基于逆坐标系的极区传递对准方法
CN103424127B (zh) * 2013-09-03 2015-09-30 哈尔滨工程大学 一种速度加比力匹配传递对准方法
CN103674068B (zh) * 2013-12-19 2017-04-12 哈尔滨工程大学 一种基于激光跟踪仪的传递对准的验证方法
CN105157724B (zh) * 2015-07-30 2017-12-26 北京航空航天大学 一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法

Also Published As

Publication number Publication date
CN105973268A (zh) 2016-09-28

Similar Documents

Publication Publication Date Title
CN105973268B (zh) 一种基于共基座安装的传递对准精度定量评估方法
CN109556632B (zh) 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法
US8781737B2 (en) Spatial alignment determination for an inertial measurement unit (IMU)
CN106990424B (zh) 一种双天线gps测姿方法
CN110501024A (zh) 一种车载ins/激光雷达组合导航系统的量测误差补偿方法
CN106643709B (zh) 一种海上运载体的组合导航方法及装置
CN109459059B (zh) 一种星敏感器外场转换基准测定系统及方法
CN104049269B (zh) 一种基于激光测距和mems/gps组合导航系统的目标导航测绘方法
CN103175528B (zh) 基于捷联惯导系统的捷联罗经姿态测量方法
CN110926468A (zh) 基于传递对准的动中通天线多平台航姿确定方法
CN107144278B (zh) 一种基于多源特征的着陆器视觉导航方法
CN104776847B (zh) 一种适用于水下导航系统单点估计陀螺漂移的方法
US20080129599A1 (en) Systems and methods for locating targets using digital elevation model survey points
CN103604428A (zh) 基于高精度水平基准的星敏感器定位方法
CN109931952A (zh) 未知纬度条件下捷联惯导直接解析式粗对准方法
KR20080086711A (ko) 관성항법시스템의 초기정렬 방법
CN105571636A (zh) 一种用于定位目标的方法及测量设备
US20140249750A1 (en) Navigational and location determination system
CN108151765A (zh) 一种在线实时估计补偿磁强计误差的定位测姿方法
CN104535078A (zh) 一种基于标志点的光电设备对飞行目标的测量方法
CN102607563B (zh) 利用背景天文信息对于航天器进行相对导航的系统
CN110514201B (zh) 一种惯性导航系统及适用于高转速旋转体的导航方法
CN202837553U (zh) 距离及方向校正的位置估测装置
CN110285811A (zh) 卫星定位和惯性导航的融合定位方法和装置
CN103033182A (zh) 确定第三目标的定位机构

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant