CN110488853A - 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 - Google Patents
一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 Download PDFInfo
- Publication number
- CN110488853A CN110488853A CN201910807545.6A CN201910807545A CN110488853A CN 110488853 A CN110488853 A CN 110488853A CN 201910807545 A CN201910807545 A CN 201910807545A CN 110488853 A CN110488853 A CN 110488853A
- Authority
- CN
- China
- Prior art keywords
- instruction
- inertial navigation
- navigation system
- calculation method
- hybrid inertial
- 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
- 238000004364 calculation method Methods 0.000 title claims abstract description 19
- 230000000087 stabilizing effect Effects 0.000 claims abstract description 7
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000000034 method Methods 0.000 abstract description 7
- 230000002045 lasting effect Effects 0.000 abstract description 2
- 230000009467 reduction Effects 0.000 abstract description 2
- 239000011159 matrix material Substances 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 2
- 239000000969 carrier Substances 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法,通过该方法可将混合式惯导系统的台体稳定在地理坐标系,同时可对惯性器件进行旋转调制。该方法的优点,在于计算内框电机稳定控制指令时,针对转轴涡动与旋转调制角速度耦合对系统姿态误差的影响,将旋转角速度施加于台体坐标系z轴方向,提高了台体的稳定精度,降低了系统姿态误差。
Description
技术领域
本发明涉及一种提高台体稳定精度、降低系统姿态误差的稳定控制指令计算方法,适用于对系统姿态精度有较高要求、需要稳定在地理坐标系的惯性导航系统,属于伺服控制领域。
技术背景
惯导系统被广泛应用于军用、民用领域的多种运载器。传统的捷联式惯导系统和平台式惯导系统,导航精度的提升主要依靠提高惯性器件的性能。混合式惯导系统不仅可以隔离载体角运动,也可以对惯性器件进行旋转调制,从而在使用同等精度的惯性器件的条件下,显著提高导航精度。
为了达到隔离载体运动的目的,一般以陀螺输出为反馈量,计算稳定指令。但是对于双轴或三轴混合式惯导系统,旋转调制会造成陀螺敏感轴与电机轴不重合。因此,需要根据载体的不同运动、不同旋转策略,将陀螺输出折算到电机轴方向,得到沿电机轴方向的稳定指令。
同时,应该注意旋转调制引入的误差对混合式惯导系统姿态输出精度的影响。例如,对于绕内框轴长时间旋转调制的混合式惯导系统,由于内框轴的涡动,平台坐标系的z轴指向不固定。此时如果将旋转调制角速度施加到地理坐标系的天向,会导致平台坐标系的水平陀螺敏感到旋转调制角速度的投影,这会导致稳定指令计算错误,系统俯仰角和横滚角出现震荡。
因此,需要为混合式惯导系统设计一套稳定指令计算方法,使得旋转机构快速、平稳、准确地跟踪导航坐标系,尽量减小旋转调制角速度与转轴涡动的耦合误差。
发明内容
本发明解决的技术问题是:针对混合式惯导系统台体需稳定于地理坐标系以及隔离载体角运动的需求,减少涡动误差对系统姿态的影响,提出一种稳定控制指令的计算方法,在隔离载体角运动的同时提高系统姿态的精度。
本发明的技术解决方案是:一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法,实现步骤如下:
(1)进行姿态解算,计算平台坐标系(p系)相对于导航坐标系(n系)的旋转角速度
(2)在平台坐标系内,扣除旋转调制角速度分量,得到稳定指令角速度
(3)对稳定指令角速度积分,得到稳定指令角度
(4)将稳定指令角度折算到电机轴上,得到电机稳定指令。
所述步骤(2)稳定指令角速度的计算公式如下:
式中,ΔRrx、ΔRry、ΔRrz分别为当前周期的中框、外框、内框的电机旋转指令。dt为控制周期
所述步骤(3)稳定指令角度的计算公式如下:
本发明的原理是:
从陀螺输出中可以提取台体相对地理坐标系的角运动信息,以此为反馈,可以计算出电机轴的稳定指令,电机带动框架旋转,实现台体快速、准确地跟踪地理坐标系。
本发明与现有技术相比的优点在于:
(1)本发明适用于不同载体角运动、不同旋转策略下的稳定指令计算。由于载体运动、框架旋转会影响电机轴的正交关系以及陀螺敏感轴与电机轴的空间角度关系,需要将陀螺输出折算到电机轴方向,才能得到正确的稳定指令计算方法。本发明利用陀螺输出、系统姿态角、IMU姿态角等数据,给出了稳定指令计算方法。
(2)本发明减小了绕内框轴旋转调制时的系统姿态误差。绕内框轴旋转调制时,如果旋转调制角速度施加在地理坐标系天向,内框转轴涡动与旋转调制角速度耦合,会造成系统姿态误差。针对这一问题,本发明更改了稳定指令计算方法,将旋转调制角速度施加在平台坐标系z轴方向,可以减小系统姿态误差。
附图说明
图1为本发明所指的稳定指令计算方法流程图。图2为摘要附图。
具体实施方式
下面以一种三轴混合式惯性导航系统为例来阐述本发明的具体实施过程。
该惯导系统可以隔离载体角运动,三轴旋转机构的内框轴、中框轴、外框轴分别指向系统的方位、俯仰、横滚,三个框架各配一个增量式光电码盘。IMU安装于该旋转机构上。
根据图1所示的流程,电机稳定指令计算方法如下:
1.姿态解算,得到姿态矩阵
2.计算
更新地球自转以及地理系相对于地球系的角速率:
式中,ωie为地球自转角速度;L为当地地理纬度;vE、vN为上一周期计算出的东向速度、北向速度;RM、RN为当前周期计算出的地球曲率半径。
经过上一时刻的转化到地理系得到
设陀螺输出为扣除得到
补偿圆锥误差后,可以用来计算稳定指令。
3.计算电机稳定指令。
光栅角为零时,x、y、z陀螺敏感轴基本指向中框轴、外框轴、内框轴。但是当载体存在俯仰运动时,三个电机轴之间不正交;当IMU绕某个电机轴进行旋转时,陀螺敏感轴与电机轴不重合;当载体俯仰角达到90°或者惯导系统绕中框轴旋转调制时,将无法隔离载体的航向运动。因此需要根据系统姿态以及不同旋转策略计算电机稳定指令。 (1)电机绕内框轴旋转时的稳定指令的计算公式如下:
式中,Rsx、Rsy、Rsz分别为中框、外框、内框的电机稳定指令;ψb为系统航向角, R(-ψb)是由-ψb构成的旋转矩阵;ΔRrx、ΔRry、ΔRrz分别为当前周期的中框、外框、内框的电机旋转指令;为当前时刻的姿态矩阵。θb为系统俯仰角。
式(11)、式(12)适用于内框轴指天情况。
对于绕中框轴或者外框轴旋转180°,使内框轴指地旋转的情况,稳定指令计算公式如下:
式中,由式(11)计算得到。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
最后所应说明的是:以上实施实例仅用以说明而非限制本发明的技术方案,所有的不脱离本发明的精神和范围的修改或局部替换,均应涵盖在本发明的权利要求范围当中。
Claims (3)
1.一种混合式惯导系统稳定控制指令的计算方法,其特征在于实现步骤如下:
(1)进行姿态解算,计算平台坐标系(p系)相对于导航坐标系(n系)的旋转角速度
(2)在平台坐标系内,扣除旋转调制角速度分量,得到稳定指令角速度
(3)对稳定指令角速度积分,得到稳定指令角度
(4)将稳定指令角度折算到电机轴上,得到电机稳定指令。
2.根据权利要求1所述的混合式惯导系统稳定控制指令的计算方法,其特征在于:所述步骤(2)稳定指令角速度的计算公式如下:
式中,ΔRrx、ΔRry、ΔRrz分别为当前周期的中框、外框、内框的电机旋转指令。dt为控制周期。
3.根据权利要求1所述的混合式惯导系统稳定控制指令的计算方法,其特征在于:所述步骤(3)稳定指令角度的计算公式如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910807545.6A CN110488853B (zh) | 2019-08-29 | 2019-08-29 | 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910807545.6A CN110488853B (zh) | 2019-08-29 | 2019-08-29 | 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110488853A true CN110488853A (zh) | 2019-11-22 |
CN110488853B CN110488853B (zh) | 2021-06-08 |
Family
ID=68553682
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910807545.6A Active CN110488853B (zh) | 2019-08-29 | 2019-08-29 | 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110488853B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115077521A (zh) * | 2022-08-22 | 2022-09-20 | 中国船舶重工集团公司第七0七研究所 | 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法 |
CN115127552A (zh) * | 2022-08-31 | 2022-09-30 | 中国船舶重工集团公司第七0七研究所 | 旋转调制方法、装置、设备及存储介质 |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05141308A (ja) * | 1991-11-22 | 1993-06-08 | Honda Motor Co Ltd | 内燃機関のウオータジヤケツト構造 |
EP0619134A1 (de) * | 1993-04-08 | 1994-10-12 | ABB Management AG | Mischkammer |
JPH09273938A (ja) * | 1996-04-04 | 1997-10-21 | Takao Yamaguchi | ハイブリッド慣性航法装置 |
WO2001046647A2 (en) * | 1999-12-22 | 2001-06-28 | Honeywell International Inc. | Method, apparatus and computer program product for estimating airplane attitude with reduced sensor set |
US20050275300A1 (en) * | 2004-06-15 | 2005-12-15 | Aly El-Shafei | Methods of controlling the instability in fluid film bearings |
KR20070091641A (ko) * | 2004-12-07 | 2007-09-11 | 사겡 데팡스 세큐리떼 | 운동 모델에 기초한 혼성형 관성 항법 시스템 |
CN101858353A (zh) * | 2010-06-03 | 2010-10-13 | 浙江大学 | 一种用于离心泵的可控涡动装置 |
CN202452059U (zh) * | 2012-01-12 | 2012-09-26 | 西安市瑞特测控技术有限责任公司 | 陀螺稳定云台 |
CN104064869A (zh) * | 2014-06-13 | 2014-09-24 | 北京航天控制仪器研究所 | 基于mems惯导的双四元数动中通天线控制方法及系统 |
KR20150010318A (ko) * | 2013-07-19 | 2015-01-28 | 현대모비스 주식회사 | 요 레이트 센서의 오프셋 보정 장치와 방법 및 상기 장치를 구비하는 차량 속도 제어 시스템 |
CN106052682A (zh) * | 2016-05-13 | 2016-10-26 | 北京航空航天大学 | 一种混合式惯性导航系统及导航方法 |
CN106289322A (zh) * | 2016-08-23 | 2017-01-04 | 北京航空航天大学 | 一种基于陀螺数据的带旋转机构的惯导系统涡动补偿方法 |
CN106767806A (zh) * | 2017-04-01 | 2017-05-31 | 北京航空航天大学 | 一种用于混合式惯性导航系统的物理平台 |
CN108006410A (zh) * | 2017-11-15 | 2018-05-08 | 湖北三江航天红峰控制有限公司 | 一种用于捷联惯导系统位置标定的双轴转位机构 |
CN207570556U (zh) * | 2017-12-31 | 2018-07-03 | 宁波迪泰电子科技有限公司 | 捷联式惯性导航与校准系统 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 |
CN108873928A (zh) * | 2017-05-10 | 2018-11-23 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种基于传感器状态评估结果的无人直升机高度保持方法 |
CN108869540A (zh) * | 2018-01-12 | 2018-11-23 | 至玥腾风科技投资集团有限公司 | 一种推力轴承、转子系统及推力轴承的控制方法 |
-
2019
- 2019-08-29 CN CN201910807545.6A patent/CN110488853B/zh active Active
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05141308A (ja) * | 1991-11-22 | 1993-06-08 | Honda Motor Co Ltd | 内燃機関のウオータジヤケツト構造 |
EP0619134A1 (de) * | 1993-04-08 | 1994-10-12 | ABB Management AG | Mischkammer |
JPH09273938A (ja) * | 1996-04-04 | 1997-10-21 | Takao Yamaguchi | ハイブリッド慣性航法装置 |
WO2001046647A2 (en) * | 1999-12-22 | 2001-06-28 | Honeywell International Inc. | Method, apparatus and computer program product for estimating airplane attitude with reduced sensor set |
US20050275300A1 (en) * | 2004-06-15 | 2005-12-15 | Aly El-Shafei | Methods of controlling the instability in fluid film bearings |
KR20070091641A (ko) * | 2004-12-07 | 2007-09-11 | 사겡 데팡스 세큐리떼 | 운동 모델에 기초한 혼성형 관성 항법 시스템 |
CN101858353A (zh) * | 2010-06-03 | 2010-10-13 | 浙江大学 | 一种用于离心泵的可控涡动装置 |
CN202452059U (zh) * | 2012-01-12 | 2012-09-26 | 西安市瑞特测控技术有限责任公司 | 陀螺稳定云台 |
KR20150010318A (ko) * | 2013-07-19 | 2015-01-28 | 현대모비스 주식회사 | 요 레이트 센서의 오프셋 보정 장치와 방법 및 상기 장치를 구비하는 차량 속도 제어 시스템 |
CN104064869A (zh) * | 2014-06-13 | 2014-09-24 | 北京航天控制仪器研究所 | 基于mems惯导的双四元数动中通天线控制方法及系统 |
CN106052682A (zh) * | 2016-05-13 | 2016-10-26 | 北京航空航天大学 | 一种混合式惯性导航系统及导航方法 |
CN106289322A (zh) * | 2016-08-23 | 2017-01-04 | 北京航空航天大学 | 一种基于陀螺数据的带旋转机构的惯导系统涡动补偿方法 |
CN106767806A (zh) * | 2017-04-01 | 2017-05-31 | 北京航空航天大学 | 一种用于混合式惯性导航系统的物理平台 |
CN108873928A (zh) * | 2017-05-10 | 2018-11-23 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种基于传感器状态评估结果的无人直升机高度保持方法 |
CN108006410A (zh) * | 2017-11-15 | 2018-05-08 | 湖北三江航天红峰控制有限公司 | 一种用于捷联惯导系统位置标定的双轴转位机构 |
CN207570556U (zh) * | 2017-12-31 | 2018-07-03 | 宁波迪泰电子科技有限公司 | 捷联式惯性导航与校准系统 |
CN108869540A (zh) * | 2018-01-12 | 2018-11-23 | 至玥腾风科技投资集团有限公司 | 一种推力轴承、转子系统及推力轴承的控制方法 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 |
Non-Patent Citations (8)
Title |
---|
DI WANG ETAL: "A Hybrid Approach Based on Improved AR Model and MAA for INS/DVL Integrated Navigation Systems", 《DIGITAL OBJECT IDENTIFIER》 * |
WAEL MOHSEN AHMED, QUAN QUAN: "Robust Hybrid Control for Ballistic Missile Longitudinal Autopilot", 《CHINESE JOURNAL OF AERONAUTICS》 * |
冯培德: "论混合式惯性导航系统", 《中国惯性技术学报》 * |
查峰等: "单轴旋转惯导系统旋转性误差分析及补偿", 《中国惯性技术学报》 * |
王学运等: "MEMS器件捷联惯导系统旋转调制技术", 《东北大学学报(自然科学版)》 * |
王蕾等: "混合式惯性导航系统全数字平台技术研究", 《兵工学报》 * |
王蕾等: "连续旋转型光纤捷联惯导系统角速度误差补偿", 《光电子 激光》 * |
王超等: "旋转调制式捷联惯导系统初始对准方案研究", 《舰船电子工程》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115077521A (zh) * | 2022-08-22 | 2022-09-20 | 中国船舶重工集团公司第七0七研究所 | 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法 |
CN115127552A (zh) * | 2022-08-31 | 2022-09-30 | 中国船舶重工集团公司第七0七研究所 | 旋转调制方法、装置、设备及存储介质 |
CN115127552B (zh) * | 2022-08-31 | 2022-11-18 | 中国船舶重工集团公司第七0七研究所 | 旋转调制方法、装置、设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN110488853B (zh) | 2021-06-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109211269B (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN104596546B (zh) | 一种单轴旋转惯导系统的姿态输出补偿方法 | |
CN106052682B (zh) | 一种混合式惯性导航系统及导航方法 | |
CN105203098A (zh) | 基于九轴mems传感器的农业机械全姿态角更新方法 | |
CN106767806B (zh) | 一种用于混合式惯性导航系统的物理平台 | |
CN104897172A (zh) | 基于运动捕捉系统的旋转mems惯导磁航向角误差补偿方法 | |
CN103900566B (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 | |
CN107270938A (zh) | 基于泰勒级数拟合的单轴旋转惯导系统姿态解调方法 | |
CN110488853A (zh) | 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法 | |
CN105588565B (zh) | 一种基于冗余配置的捷联惯导系统双轴旋转调制方法 | |
CN115773751B (zh) | 一种修正等效天向加计零位造成对准误差的方法 | |
CN102798399A (zh) | 基于双轴转动方案的捷联惯导系统误差抑制方法 | |
CN110926447B (zh) | 一种具有自主导航功能的单轴光纤陀螺寻北方法及航姿导航方法 | |
CN103900607A (zh) | 一种基于惯性系的旋转式捷联惯导系统转位方法 | |
CN110058288A (zh) | 无人机ins/gnss组合导航系统航向误差修正方法及系统 | |
CN112129321B (zh) | 陀螺零偏标定值确定方法、装置及计算机存储介质 | |
CN111735474A (zh) | 一种基于数据回溯的动基座罗经对准方法 | |
CN114061572A (zh) | 一种用于旋转式惯导系统的双轴旋转调制方法 | |
CN103968840A (zh) | 一种全数字控制平台式惯性导航系统 | |
CN111551164B (zh) | 速率偏频激光陀螺寻北仪航向效应误差的补偿方法 | |
CN112729332B (zh) | 一种基于旋转调制的对准方法 | |
CN104121930B (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN107063309A (zh) | 一种旋转式捷联惯导陀螺标度误差补偿策略 | |
CN115574817B (zh) | 一种基于三轴旋转式惯导系统的导航方法及导航系统 | |
CN104236533A (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 |