CN111537002A - 一种激光捷联惯组安装误差的标定方法和定向方法 - Google Patents
一种激光捷联惯组安装误差的标定方法和定向方法 Download PDFInfo
- Publication number
- CN111537002A CN111537002A CN202010548724.5A CN202010548724A CN111537002A CN 111537002 A CN111537002 A CN 111537002A CN 202010548724 A CN202010548724 A CN 202010548724A CN 111537002 A CN111537002 A CN 111537002A
- Authority
- CN
- China
- Prior art keywords
- measurement unit
- inertial measurement
- strapdown inertial
- installation error
- launcher
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, 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
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
Description
技术领域
本发明涉及定向技术领域,具体涉及一种激光捷联惯组安装误差的标定方法。
背景技术
现有技术中,为提高倾斜发射系统的初始瞄准精度,通过将测量姿态的激光捷联惯组与发射架固联的安装方式减少中间传递环节所带来的误差,激光捷联惯组随发射架起竖而具有俯仰运动,激光捷联惯组在俯仰运动中实时测量出发射架的方位角。激光捷联惯组与发射架之间存在安装误差,具体表现为:在发射车调平工况下,发射架起竖过程中,发射架载体系方位角应保持不变,而实际上由于激光捷联惯组的方位轴不平行于发射架的方位轴(即二者之间存在安装误差),造成发射架在起竖过程中,激光捷联惯组输出方位角不能准确反映发射架的方位角。
发明内容
鉴于上述问题,本发明实施例提供一种激光捷联惯组安装误差的标定方法和定向方法,解决现有固联的激光捷联惯组测量存在误差的技术问题。
本发明实施例的激光捷联惯组安装误差的标定方法,包括:
本发明一实施例中,还包括:
本发明实施例的倾斜发射装置的定向方法,包括:
根据发射架调平工况时激光捷联惯组输出的调平俯仰角和调平横滚角形成发射架的俯仰安装误差和横滚安装误差;
根据所述发射架起竖过程启停时所述激光捷联惯组输出的起竖俯仰角和起竖横滚角形成所述发射架竖起的方向安装误差;
本发明实施例的激光捷联惯组安装误差的标定方法和定向方法采用激光捷联惯组在发射架调平工况下,进行水平安装误差标定,不受激光捷联惯组水平姿态误差影响,水平安装误差标定完成后,将发射架起竖,记录相关数据,通过简单计算得到方向安装误差补偿量。从实现过程可以看出,该标定方法与对准精度无关,短时内惯组导航精度高,标定简单易行,不需额外的高精度寻北仪辅助测量。
附图说明
图1所示为本发明一实施例激光捷联惯组安装误差的标定方法的处理流程示意图。
图2所示为本发明一实施例倾斜发射装置的定向方法的处理流程示意图。
具体实施方式
为使本发明的目的、技术方案及优点更加清楚、明白,以下结合附图及具体实施方式对本发明作进一步说明。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本领域技术人员可以理解,激光捷联惯组利用激光陀螺和加速度计的信息进行初始对准,输出的姿态信息包括方位角和水平姿态角,水平姿态角包括俯仰角和横滚角。导航坐标系n相对于激光捷联惯组坐标系b的姿态信息通过捷联解算能实时得到。激光捷联惯组的姿态是通过姿态矩阵来表征的,激光捷联惯组的空间姿态通过三次连续欧拉角旋转得到,可以看做依次绕方位轴(z轴)、俯仰轴(x轴)、横滚轴(y轴)做基本旋转后的复合结果,其中绕z轴旋转方位角绕x轴旋转俯仰角θ,绕y轴旋转横滚角γ,各次基本旋转对应的变换矩阵为:
因此导航系n相对于激光捷联惯组坐标系b的姿态矩阵为:
本发明一实施例激光捷联惯组安装误差的标定方法如图1所示。在图1中,本实施例包括:
本领域技术人员可以理解,由于安装误差的存在使得激光捷联惯组(载体)坐标系b和发射架(载体)坐标系B不重合,而安装误差μ的分量μx、μy和μz都为小量。因此发射架坐标系B相对于激光捷联惯组坐标系b的姿态矩阵可以表示为:
本领域技术人员可以理解,发射架调平可以采用横滚角γ调平-俯仰角θ调平的顺序逐步获得,在实现调平工况时标定与俯仰安装误差和横滚安装误差对应的俯仰角和横滚角。具体调平过程表示如下:
发射架的横滚角γ调整为零:
发射架的俯仰角θ调整为零:
本领域技术人员可以理解,发射架调平可以采用横滚角γ调平-俯仰角θ调平的顺序逐步获得,在实现调平工况时标定与俯仰安装误差和横滚安装误差对应的俯仰角和横滚角。具体调平过程表示如下:
发射架的横滚角γ调整为零:
发射架的俯仰角θ调整为零:
本发明实施例的激光捷联惯组安装误差的标定方法采用激光捷联惯组在发射架调平工况下,进行水平安装误差标定,不受激光捷联惯组水平姿态误差影响,水平安装误差标定完成后,将发射架起竖,记录相关数据,通过简单计算得到方向安装误差补偿量。从实现过程可以看出,该标定方法与对准精度无关,短时内惯组导航精度高,标定简单易行,不需额外的高精度寻北仪辅助测量。
本发明一实施例倾斜发射装置的定向方法如图2所示。在图2中,本实施例包括:
步骤700:根据发射架调平工况时激光捷联惯组输出的调平俯仰角和调平横滚角形成发射架的俯仰安装误差和横滚安装误差。
本领域技术人员可以理解,发射架调平工况时发射架的x轴和y轴可以采用现有仪器保持水平状态。当固联的激光捷联惯组在发射架调平工况时存在非零输出可以判断存在安装误差,在x、y两个轴向上的误差可以利用激光捷联惯组的非零输出量化。水平安装误差以激光捷联惯组输出的俯仰角μx和横滚角μy表示为:
其中θ′为激光捷联惯组输出的绕发射架x轴旋转的俯仰角,γ′为激光捷联惯组输出的绕发射架y轴旋转的横滚角。
步骤800:根据发射架起竖过程启停时激光捷联惯组输出的起竖俯仰角和起竖横滚角形成发射架竖起的方向安装误差。
本领域技术人员可以理解,根据姿态矩阵可以推导出各方向安装误差角度间的转换关系,根据俯仰角误差和横滚角误差可以获得方向角误差,发射架起竖过程中水平起始时的方向安装误差μz以水平时激光捷联惯组输出的俯仰角和横滚角表示为:
其中水平的方向安装误差μz为等效的绕发射架z轴旋转的方位角。
假设发射架水平时和起竖时的俯仰角和横滚角误差一致。为了克服发射架起竖过程中激光捷联惯组姿态输出存在的精度误差,方向安装误差μz以起竖过程中发射架水平和竖起时输出的俯仰角和横滚角表示为:
其中竖起后的俯仰角和横滚角为θ′1和γ′1,水平时的俯仰角和横滚角为θ′0和γ′0。
步骤900:根据方向安装误差、俯仰安装误差和横滚安装误差形成发射架相对激光捷联惯组的误差姿态矩阵,根据误差姿态矩阵形成发射架坐标系相对导航坐标系的姿态矩阵。
本发明实施例的倾斜发射装置的倾斜定向方法利用发射架调平工况准确标定激光捷联惯组的安装误差数据,并形成误差姿态矩阵进行误差补偿。利用现有惯导姿态矩阵的成熟运算过程将激光捷联惯组的方位角误差在起竖过程中消除,使得激光捷联惯组的测量输出可以准确地反映出发射架的方位角。
在本发明一实施例中,为了克服激光捷联惯组测量精度造成的误差,采用以下方法获得形成误差姿态矩阵的方向安装误差、俯仰安装误差和横滚安装误差的测量值:
步骤a01:将发射架调平;
步骤a02:激光捷联惯组开机寻北,记录输出的俯仰角θi和横滚角γi;
步骤a03:重复步骤a02,获取若干组俯仰角θi和横滚角γi后对俯仰角θi和横滚角γi分别取平均值后形成俯仰安装误差μx和横滚安装误差μy。
步骤a04:激光捷联惯组开机寻北,开始发射架起竖过程,记录起竖水平起始点的俯仰角θ0i和横滚角γ0i和发射架起竖到位点的俯仰角θ1i和横滚值γ1i,形成单次方向安装误差角μzi;
步骤a05:重复步骤a04,获得若干单次方向安装误差角μzi后取平均值形成方向安装误差μz。
本发明实施例的倾斜发射装置的倾斜定向方法有利于消除激光捷联惯组的系统误差,克服发射架受环境干扰因素引入的操作误差。
本发明一实施例的激光捷联惯组安装误差的标定方法,包括:
存储器,用于存储上述实施例激光捷联惯组安装误差的标定方法处理过程的程序代码;
处理器,用于执行上述实施例激光捷联惯组安装误差的标定方法处理过程的程序代码。
本发明一实施例的倾斜发射装置的定向方法,包括:
存储器,用于存储上述实施例倾斜发射装置的定向方法处理过程的程序代码;
处理器,用于执行上述实施例倾斜发射装置的定向方法处理过程的程序代码。
处理器可以采用DSP(Digital Signal Processor)数字信号处理器、FPGA(Field-Programmable Gate Array)现场可编程门阵列、MCU(Microcontroller Unit)系统板、SoC(system on a chip)系统板或包括I/O的PLC(Programmable Logic Controller)最小系统。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求书的保护范围为准。
Claims (10)
10.如权利要求9所述的倾斜发射装置的定向方法,其特征在于,形成形成所述误差姿态矩阵的所述方向安装误差、所述俯仰安装误差和所述横滚安装误差的测量值包括:
步骤a01:将发射架调平;
步骤a02:激光捷联惯组开机寻北,记录输出的俯仰角θi和横滚角γi;
步骤a03:重复步骤a02,获取若干组俯仰角θi和横滚角γi后对俯仰角θi和横滚角γi分别取平均值后形成俯仰安装误差μx和横滚安装误差μy;
步骤a04:激光捷联惯组开机寻北,开始发射架起竖过程,记录起竖水平起始点的俯仰角θ0i和横滚角γ0i和发射架起竖到位点的俯仰角θ1i和横滚值γ1i,形成单次方向安装误差角μzi;
步骤a05:重复步骤a04,获得若干单次方向安装误差角μzi后取平均值形成方向安装误差μz。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010548724.5A CN111537002B (zh) | 2020-06-16 | 2020-06-16 | 一种激光捷联惯组安装误差的标定方法和定向方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010548724.5A CN111537002B (zh) | 2020-06-16 | 2020-06-16 | 一种激光捷联惯组安装误差的标定方法和定向方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111537002A true CN111537002A (zh) | 2020-08-14 |
CN111537002B CN111537002B (zh) | 2022-05-24 |
Family
ID=71974542
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010548724.5A Active CN111537002B (zh) | 2020-06-16 | 2020-06-16 | 一种激光捷联惯组安装误差的标定方法和定向方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111537002B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112129322A (zh) * | 2020-09-22 | 2020-12-25 | 重庆华渝电气集团有限公司 | 一种捷联惯组与三轴转台的安装误差检测方法及校正方法 |
CN113551688A (zh) * | 2021-05-27 | 2021-10-26 | 北京航天发射技术研究所 | 车载定位定向导航设备无依托快速免拆卸标定方法及装置 |
CN114001754A (zh) * | 2021-10-29 | 2022-02-01 | 北京航天发射技术研究所 | 一种航向调整方法、航向调整装置、可读介质及寻北仪 |
CN114047486A (zh) * | 2021-10-28 | 2022-02-15 | 中国电子科技集团公司第二十九研究所 | 一种雷达导引头挂飞试验安装误差角标定方法及存储介质 |
CN115855116A (zh) * | 2023-02-08 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 误差标定工艺生成方法及系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航系统的快速精对准方法 |
CN102435206A (zh) * | 2011-09-01 | 2012-05-02 | 中国航空工业第六一八研究所 | 捷联惯导系统机上安装偏角的自动标定及补偿方法 |
CN104634346A (zh) * | 2015-02-13 | 2015-05-20 | 西安应用光学研究所 | 基于光纤陀螺的光电平台姿态检测方法 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 |
CN110006458A (zh) * | 2019-04-25 | 2019-07-12 | 北京航天发射技术研究所 | 一种用于激光捷联惯组的标定装置和标定方法 |
CN110823255A (zh) * | 2019-11-25 | 2020-02-21 | 西安爱生技术集团公司 | 一种基于比力观测无需调平引北的系统级自标定方法 |
-
2020
- 2020-06-16 CN CN202010548724.5A patent/CN111537002B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航系统的快速精对准方法 |
CN102435206A (zh) * | 2011-09-01 | 2012-05-02 | 中国航空工业第六一八研究所 | 捷联惯导系统机上安装偏角的自动标定及补偿方法 |
CN104634346A (zh) * | 2015-02-13 | 2015-05-20 | 西安应用光学研究所 | 基于光纤陀螺的光电平台姿态检测方法 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 |
CN110006458A (zh) * | 2019-04-25 | 2019-07-12 | 北京航天发射技术研究所 | 一种用于激光捷联惯组的标定装置和标定方法 |
CN110823255A (zh) * | 2019-11-25 | 2020-02-21 | 西安爱生技术集团公司 | 一种基于比力观测无需调平引北的系统级自标定方法 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112129322A (zh) * | 2020-09-22 | 2020-12-25 | 重庆华渝电气集团有限公司 | 一种捷联惯组与三轴转台的安装误差检测方法及校正方法 |
CN112129322B (zh) * | 2020-09-22 | 2022-11-22 | 重庆华渝电气集团有限公司 | 一种捷联惯组与三轴转台的安装误差检测方法及校正方法 |
CN113551688A (zh) * | 2021-05-27 | 2021-10-26 | 北京航天发射技术研究所 | 车载定位定向导航设备无依托快速免拆卸标定方法及装置 |
CN114047486A (zh) * | 2021-10-28 | 2022-02-15 | 中国电子科技集团公司第二十九研究所 | 一种雷达导引头挂飞试验安装误差角标定方法及存储介质 |
CN114047486B (zh) * | 2021-10-28 | 2023-04-07 | 中国电子科技集团公司第二十九研究所 | 一种雷达导引头挂飞试验安装误差角标定方法及存储介质 |
CN114001754A (zh) * | 2021-10-29 | 2022-02-01 | 北京航天发射技术研究所 | 一种航向调整方法、航向调整装置、可读介质及寻北仪 |
CN115855116A (zh) * | 2023-02-08 | 2023-03-28 | 中国船舶集团有限公司第七〇七研究所 | 误差标定工艺生成方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN111537002B (zh) | 2022-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111537002B (zh) | 一种激光捷联惯组安装误差的标定方法和定向方法 | |
US6876926B2 (en) | Method and system for processing pulse signals within an inertial navigation system | |
CN106525073B (zh) | 一种基于三轴转台的惯性空间陀螺标定试验方法 | |
CN101608920B (zh) | 一种组合式空间位姿精密动态测量装置及方法 | |
CN104154928B (zh) | 一种适用于惯性平台内置式星敏感器的安装误差标定方法 | |
WO2016112571A1 (zh) | 一种高精度光纤陀螺惯测装置标定方法 | |
CN108549771A (zh) | 一种挖掘机辅助施工系统及方法 | |
CN102564455B (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN111323050A (zh) | 一种捷联惯导和多普勒组合系统标定方法 | |
CN106969783A (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN104880200B (zh) | 复合制导系统初始姿态现场校准系统及方法 | |
CN112129322B (zh) | 一种捷联惯组与三轴转台的安装误差检测方法及校正方法 | |
CN110095659B (zh) | 深空探测巡视器通讯天线指向精度动态测试方法 | |
CN102679999A (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN109631952A (zh) | 航天器用光学陀螺组件姿态基准镜安装误差标定方法 | |
CN110044319A (zh) | 一种捷联惯导系统减振器变形的测量方法和测量装置 | |
CN111207734B (zh) | 一种基于ekf的无人机组合导航方法 | |
CN114509071B (zh) | 一种风洞试验模型姿态测量方法 | |
CN113551688A (zh) | 车载定位定向导航设备无依托快速免拆卸标定方法及装置 | |
CN106895854B (zh) | 一种星光修正精度地面试验方法 | |
CN113375692B (zh) | 一种快速评估光纤陀螺标定精度的方法 | |
CN118225086B (zh) | 一种惯性系下位姿精密积分解算方法及系统 | |
CN115452028B (zh) | 传感器标定方法、系统、作业机械及电子设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |