CN1932444B - 适用于高速旋转体的姿态测量方法 - Google Patents
适用于高速旋转体的姿态测量方法 Download PDFInfo
- Publication number
- CN1932444B CN1932444B CN200610048389A CN200610048389A CN1932444B CN 1932444 B CN1932444 B CN 1932444B CN 200610048389 A CN200610048389 A CN 200610048389A CN 200610048389 A CN200610048389 A CN 200610048389A CN 1932444 B CN1932444 B CN 1932444B
- Authority
- CN
- China
- Prior art keywords
- axis
- accelerometer
- rotary body
- speed rotary
- carrier
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明为适用于高速旋转体的姿态测量方法,涉及旋转体的姿态测量方法。本发明解决现有载体姿态测量方法无法适用于轴向高速旋转载体的问题。该测量方法是在载体上安装测量轴分别与载体坐标系的纵轴、横轴、竖轴相重合的三个加速度计Ax、Ay、Az和测量轴分别与横轴、竖轴相重合的两个速率陀螺仪Gy、Gz;在载体上还安装有测量轴与横轴的负方向相重合的辅助加速度计A′y;高速旋转体纵轴的角速度ωx由如下计算表达式求得:后续的姿态解算与导航解算便可借助捷联惯性导航系统中的相关理论和方法完成。该方法可实现高速旋转体的姿态测量。
Description
技术领域
本发明涉及旋转体(如飞行器)的惯性导航技术,特别涉及高速旋转体的姿态测量方法,具体为一种适用于高速旋转体的姿态测量方法。
背景技术
捷联原文为“strapdown”,有“直接固联”的意思。捷联式姿态测量系统是将惯性测量元件直接安装在载体上,省去了惯性平台的台体,代之以存贮在计算机中的“数学平台”。捷联式姿态测量系统是一个信息处理系统,即载体安装的惯性测量元件所测量的飞行器运动信息,经过计算机处理成所需要的导航和控制信息。由于省去了物理平台,所以结构简单,体积、重量和成本都大大降低,而且维护方便。捷联式系统提供的信息全部是数字信息,特别适合在采用数字飞行控制系统的飞行器上。
现有的捷联式姿态测量方法是直接在载体上安装三个加速度计和三个速率陀螺仪,三个加速度计Ax、Ay、Az和三个速率陀螺仪Gx、Gy、Gz的测量轴分别与载体坐标系b的纵轴oxb(也称滚动轴,向前)、横轴oyb(也称俯仰轴,向右)以及竖轴ozb(也称偏航轴,向下)相重合(如图1所示)。加速度计和速率陀螺仪以及后续处理装置置于一个壳体内,而形成惯性导航系统或装置。该测量方法通常是敏感oxb、oyb以及ozb三个轴向上的线加速度和旋转角速率(角度)。在得到三个轴向的线加速度ax、ay、az和旋转角速率ωx、ωy、ωz的输出值后,利用捷联惯导系统中以四元数为基础的等效旋转矢量算法,对旋转体的实时姿态信息进行更新和提取。我们称这种测量方法为全加速度计阵列和纯陀螺的姿态测试方法。
在实际中,有些载体(飞行器,如弹体)滚动轴向(oxb)转速非常高(即为高速旋转体),而其余轴的转速相对较低。现有速率陀螺仪受测量精度和测量范围的限制,无法及时感知高速旋转体滚动轴向的旋转角速率,使测量系统工作不可靠,而无法正常工作。因此,现有的捷联式姿态测量方法仅适用于轴向低速旋转的载体,无法适用于轴向高速旋转载体。
发明内容
本发明为了解决现有载体姿态测量方法无法适用于轴向高速旋转载体的问题,提供一种适用于高速旋转体的姿态测量方法。
本发明是采用如下技术方案实现的:适用于高速旋转体的姿态测量方法,在载体上安装测量轴分别与载体坐标系的纵轴(滚动轴)oxb、横轴(俯仰轴)oyb、竖轴(偏航轴)ozb相重合的三个加速度计Ax、Ay、Az和测量轴分别与横轴oyb、竖轴ozb相重合的两个速率陀螺仪Gy、Gz,加速度计Ax、Ay、Az分别输出三个轴向线加速度比力信息ax、ay、az,速率陀螺仪Gy、Gz分别输出横轴oyb和竖轴ozb的旋转角速度ωy、ωz;在载体上还安装有测量轴与横轴(俯仰轴)oyb的负方向相重合的辅助加速度计A′y;高速旋转体纵轴(滚动轴)的角速度ωx由如下计算表达式求得:
式中,r为加速度计Ay和A′y距离惯性导航系统(装置)中心的安装距离,ay、ay′分别为加速度计Ay和A′y输出的线加速度的比力信息;在得到高速旋转体三个轴向的旋转角速度ωx、ωy、ωz和线加速度ax、ay、az之后,后续的姿态解算与导航解算便可借助捷联惯性导航系统中的相关理论和方法完成,即利用捷联惯导系统中以四元数为基础的等效旋转矢量算法,对旋转体的实时姿态信息进行更新和提取。
本发明摒弃了全加速度计阵列和纯陀螺的姿态测量方法,而是采用一种综合应用加速度计与陀螺仪输出信息的新型姿态测量方法。本发明所述的测量方法有效地解决了现有MEMS惯性敏感元件——速率陀螺仪在测量精度和测量范围方面,无法满足高速旋转体姿态测量的现状。在现有速率陀螺仪的基础上,该方法可实现高速旋转体的姿态测量。
附图说明
图1为现有旋转体姿态测量方法中加速度计和速率陀螺仪的安装位置示意图;
图2为本发明所述的适用于高速旋转体的姿态测量方法中加速度计和速率陀螺仪的安装位置示意图;
具体实施方式
适用于高速旋转体的姿态测量方法,在载体上安装测量轴分别与载体坐标系的纵轴(滚动轴)oxb、横轴(俯仰轴)oyb、竖轴(偏航轴)ozb相重合的三个加速度计Ax、Ay、Az和测量轴分别与横轴oyb、竖轴ozb相重合的两个速率陀螺仪Gy、Gz,其中,加速度计Ax、Ay、Az分别输出三个轴向线加速度比力信息ax、ay、az,速率陀螺仪Gy、Gz分别输出横轴(俯仰轴)oyb和竖轴(偏航轴)ozb的旋转角速度ωy、ωz;在载体上还安装有测量轴与横轴(俯仰轴)oyb的负方向相重合的辅助加速度计A′y;高速旋转体纵轴(滚动轴)的角速度ωx由如下计算表达式求得:
式中,r为加速度计Ay和A′y距离惯性导航系统(装置)中心的安装距离,ay、ay′分别为加速度计Ay和A′y输出的线加速度的比力信息;在得到高速旋转体三个轴向的旋转角速度ωx、ωy、ωz和线加速度ax、ay、az之后,后续的姿态解算与导航解算便可借助捷联惯性导航系统中的相关理论和方法完成,即利用捷联惯导系统中以四元数为基础的等效旋转矢量算法,对旋转体的实时姿态信息进行更新和提取。
Claims (1)
1.一种适用于高速旋转体的姿态测量方法,在载体上安装测量轴分别与载体坐标系的纵轴oxb、横轴oyb、竖轴ozb相重合的三个加速度计Ax、Ay、Az和测量轴分别与横轴oyb、竖轴ozb相重合的两个速率陀螺仪Gy、Gz,加速度计Ax、Ay、Az分别输出三个轴向线加速度比力信息ax、ay、az,速率陀螺仪Gy、Gz分别输出横轴oyb和竖轴ozb的旋转角速度ωy、ωz;其特征为:在载体上还安装有测量轴与横轴oyb的负方向相重合的辅助加速度计A′y;高速旋转体纵轴的角速度ωx由如下计算表达式求得:
式中,r为加速度计Ay和A′y距离惯性导航系统中心的安装距离,ay、ay′分别为加速度计Ay和A′y输出的线加速度比力信息;在得到高速旋转体三个轴向的旋转角速度ωx、ωy、ωz和线加速度ax、ay、az之后,后续的姿态解算与导航解算利用捷联惯导系统中以四元数为基础的等效旋转矢量算法完成。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200610048389A CN1932444B (zh) | 2006-09-30 | 2006-09-30 | 适用于高速旋转体的姿态测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200610048389A CN1932444B (zh) | 2006-09-30 | 2006-09-30 | 适用于高速旋转体的姿态测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1932444A CN1932444A (zh) | 2007-03-21 |
CN1932444B true CN1932444B (zh) | 2010-05-12 |
Family
ID=37878397
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200610048389A Expired - Fee Related CN1932444B (zh) | 2006-09-30 | 2006-09-30 | 适用于高速旋转体的姿态测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN1932444B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101105503B (zh) * | 2007-06-02 | 2010-10-27 | 中北大学 | 捷联式惯导测量组合中加速度计装配误差标量修正方法 |
CN101514900B (zh) * | 2009-04-08 | 2011-01-26 | 哈尔滨工程大学 | 一种单轴旋转的捷联惯导系统初始对准方法 |
CN102155886B (zh) * | 2011-01-24 | 2012-04-25 | 中北大学 | 一种适用于高旋弹药的主动式半捷联惯性测量装置 |
CN103075930B (zh) * | 2012-12-25 | 2014-09-24 | 中北大学 | 适用于高速旋转弹体炮口初始姿态的测量方法 |
CN103776450B (zh) * | 2014-02-28 | 2016-08-17 | 中北大学 | 适用于高速旋转飞行体的半捷联式惯性测量与导航算法 |
CN103983267A (zh) * | 2014-06-03 | 2014-08-13 | 中北大学 | 基于螺旋矢量的捷联姿态位置一体化更新算法 |
CN105509703B (zh) * | 2015-12-08 | 2019-08-23 | 北京健德乾坤导航系统科技有限责任公司 | 用于旋转弹的横滚角的计算方法 |
CN109373998B (zh) * | 2018-10-11 | 2020-07-17 | 重庆天箭惯性科技股份有限公司 | 基于多传感器数据的旋转体姿态测量方法 |
CN109373832B (zh) * | 2018-12-07 | 2020-11-06 | 惠州学院 | 基于磁测滚转的旋转弹炮口初始参数测量方法 |
CN110514201B (zh) * | 2019-08-16 | 2023-06-23 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统及适用于高转速旋转体的导航方法 |
CN111220114B (zh) * | 2020-01-20 | 2021-02-05 | 山东大学 | 一种单轴旋转载体转轴转角惯性测量系统及方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3924824A (en) * | 1973-10-17 | 1975-12-09 | Singer Co | Cross track strapdown inertial quidance system |
GB2106245A (en) * | 1981-09-18 | 1983-04-07 | Sagem | Improvements to gyroscopic navigational installations |
CN1664506A (zh) * | 2004-03-05 | 2005-09-07 | 清华大学 | 一种载体姿态测量方法及其系统 |
-
2006
- 2006-09-30 CN CN200610048389A patent/CN1932444B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3924824A (en) * | 1973-10-17 | 1975-12-09 | Singer Co | Cross track strapdown inertial quidance system |
GB2106245A (en) * | 1981-09-18 | 1983-04-07 | Sagem | Improvements to gyroscopic navigational installations |
CN1664506A (zh) * | 2004-03-05 | 2005-09-07 | 清华大学 | 一种载体姿态测量方法及其系统 |
Also Published As
Publication number | Publication date |
---|---|
CN1932444A (zh) | 2007-03-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1932444B (zh) | 适用于高速旋转体的姿态测量方法 | |
CN107588769B (zh) | 一种车载捷联惯导、里程计及高程计组合导航方法 | |
CN100593689C (zh) | 基于捷联惯性导航系统的姿态估计和融合的方法 | |
CN201561759U (zh) | 惯性姿态方位测量装置 | |
CN106052682B (zh) | 一种混合式惯性导航系统及导航方法 | |
CN101629969B (zh) | 一种低精度光纤惯组输出误差的标定补偿和测试方法及装置 | |
CN103712622B (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN100545579C (zh) | 适用于高速旋转体的半捷联式姿态测量方法 | |
CN103925930B (zh) | 一种重力仪双轴陀螺稳定平台航向误差效应的补偿方法 | |
CN104864874B (zh) | 一种低成本单陀螺航位推算导航方法及系统 | |
CN107202578B (zh) | 一种基于mems技术的捷联式垂直陀螺仪解算方法 | |
CN103630146A (zh) | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 | |
CN108007477A (zh) | 一种基于正反向滤波的惯性行人定位系统误差抑制方法 | |
CN103175528A (zh) | 基于捷联惯导系统的捷联罗经姿态测量方法 | |
CN103017764A (zh) | 高速列车自主导航及姿态测量装置 | |
CN113340298A (zh) | 一种惯导和双天线gnss外参标定方法 | |
CN104848818A (zh) | Stewart平台姿态测量装置及测量方法 | |
CN103869097B (zh) | 旋转弹航向角、俯仰角角速率测量方法 | |
RU2256881C2 (ru) | Способ определения параметров ориентации и навигации и бесплатформенная инерциальная навигационная система для быстровращающихся объектов | |
CN105241474A (zh) | 一种斜置构型惯导系统标定方法 | |
CN110132267B (zh) | 空天地一体化飞行器的光纤惯导系统及光纤惯导在轨对准方法 | |
CN111141283A (zh) | 一种通过地磁数据判断行进方向的方法 | |
CN103884868B (zh) | 一种六维加速度采集方法 | |
CN111649738B (zh) | 微重力场下的加速度计初始姿态解算方法 | |
CN115523919A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100512 Termination date: 20210930 |