CN111006660A - 一种组合惯导姿态计算方法 - Google Patents
一种组合惯导姿态计算方法 Download PDFInfo
- Publication number
- CN111006660A CN111006660A CN201911267984.9A CN201911267984A CN111006660A CN 111006660 A CN111006660 A CN 111006660A CN 201911267984 A CN201911267984 A CN 201911267984A CN 111006660 A CN111006660 A CN 111006660A
- Authority
- CN
- China
- Prior art keywords
- axis
- attitude
- satellite
- signal intensity
- acceleration
- 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.)
- Pending
Links
- 238000004364 calculation method Methods 0.000 title claims abstract description 16
- 230000001133 acceleration Effects 0.000 claims abstract description 33
- 230000004927 fusion Effects 0.000 claims abstract description 22
- 238000005070 sampling Methods 0.000 claims abstract description 8
- 238000001514 detection method Methods 0.000 claims abstract description 4
- 238000000034 method Methods 0.000 claims description 4
- 238000004891 communication Methods 0.000 description 6
- 230000003068 static effect Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开了一种组合惯导姿态计算方法,包括在第一采样周期,通过三轴加速度传感器和三轴磁力计采集载体第一加速度数据和磁力计数据,并据此计算第一姿态,第一姿态发送至姿态融合模块,第一姿态作为三轴陀螺仪的初始姿态;在第二采样周期,通过三轴陀螺传感器和三轴加速度传感器采集载体角速度和加速度;通过卫星信号强度检测模块对天线束波指向卫星方向的信号强度进行检测,并获得航向误差和俯仰角误差;通过姿态融合模块对三轴角速度变化、加速度变化和卫星信号强度进行姿态融合,得到姿态的估算值并据此控制天线电机对卫星进行跟踪,将跟踪卫星检测的信号强度信息反馈至姿态融合模块进行姿态融合。本发明为提高了导航精度和可靠性。
Description
技术领域
本发明属于姿态测量技术领域,具体涉及一种组合惯导姿态计算方法。
背景技术
陀螺仪和加速度计相结合,并通过导航信息修正航向的方法是现有技术 中常用的方法。由于陀螺仪动态性能好,但由于其存在零漂,经过长时间累 积,姿态估算将不准确,而加速度计测量值随时间变化较小,因此通常将陀 螺仪和加速度计结合,采用互补滤波器或扩展卡尔曼滤波估算姿态。
现有技术采用导航信息进行航向修正,而惯性导航设备得到准确航向要 求设备在单位时间内得到不同载***置信息,即要求载体运动,因而当载体 静止或者低速时,惯性导航信息不准确;若需在载体静止时提高惯导导航信 息准确度,需采用双天线测向接收机,其原理:利用前后天线卫星信号进行 自身位置信息解算,结合卫星接收天线间距不变的条件,估算航向角,采用 双天线的安装间隔(基线)有距离要求,对小型的动中通无法部署;在某些特 性情况,如作战环境下,若需卫星动中通进行通信,此时惯性导航信息可能被干扰或是引导,将导致航向无法修正而使卫星动中通最终不可用。
申请号为CN201611224529.7的中国专利《基于卫星通信的组合惯导姿 态计算方法》,采用卫星信号强度进行航向修正,不论载体处于静止或运动, 只要卫星动中通处于对星状态,便可根据接收的卫星信号强度,检测出天线 波束指向与卫星方向的误差,反馈给惯导进行航向修正,并且与天线电机之 间形成闭环控制,降低对惯导姿态估算准确度的要求。但是其在导航精度和 可靠度方面仍具有提高空间。
发明内容
本发明的目的是提供一种组合惯导姿态计算方法,能够提高导航精度和 可靠度。
本发明所采用的技术方案是:一种组合惯导姿态计算方法,其特征在于, 包括如下步骤:
步骤一、在第一采样周期,通过三轴加速度传感器采集载体x轴、y轴 和z轴的第一加速度数据,通过三轴磁力计采集载体x轴、y轴和z轴的磁 力计数据;
步骤二、根据磁力计数据和所述第一加速度计数据计算第一姿态,第一 姿态发送至姿态融合模块,所述第一姿态作为三轴陀螺仪的初始姿态;
步骤三、在第二采样周期,通过三轴陀螺传感器采集载体x轴、y轴和 z轴的角速度,并对角速度积分获得三轴角度变化;三轴加速度传感器采集 载体x轴、y轴和z轴的加速度,获得加速度变化;
步骤四、通过卫星信号强度检测模块对天线束波指向卫星方向的信号强 度进行检测,并对信号强度进行解调后获得航向误差和俯仰角误差;
步骤五、通过姿态融合模块对三轴角速度变化、加速度变化和卫星信号 强度进行姿态融合,得到姿态的估算值;
步骤六、通过姿态的估算值控制天线电机对卫星进行跟踪,再将跟踪卫 星检测的信号强度信息反馈至姿态融合模块进行姿态融合,形成闭环。
本发明的特点还在于:
三轴磁力计采用Metrolab TFM1186三轴磁力计。
三轴加速度传感器采用ADXL335BCPZ加速度传感器。
三轴加速度传感器采用LIS3DH三轴加速度计。
三轴陀螺仪采用MEMS陀螺仪。
三轴陀螺仪采用MEMS陀螺仪。
本发明的有益效果是:
本发明一种组合惯导姿态计算方法,通过第一姿态作为三轴陀螺仪的初 始姿态,通过姿态融合包括第一姿态,提高导航精度和可靠性实现各种环境 下的准确导航。
具体实施方式
下面对本发明创造做进一步详细说明。
一种组合惯导姿态计算方法,包括如下步骤:
步骤一、在第一采样周期,通过三轴加速度传感器采集载体x轴、y轴 和z轴的第一加速度数据,通过三轴磁力计采集载体x轴、y轴和z轴的磁 力计数据。
步骤二、根据磁力计数据和所述第一加速度计数据计算第一姿态,第一 姿态发送至姿态融合模块,所述第一姿态作为三轴陀螺仪的初始姿态。
步骤三、在第二采样周期,通过三轴陀螺传感器采集载体x轴、y轴和 z轴的角速度,并对角速度积分获得三轴角度变化;三轴加速度传感器采集 载体x轴、y轴和z轴的加速度,获得加速度变化。
步骤四、通过卫星信号强度检测模块对天线束波指向卫星方向的信号强 度进行检测,并对信号强度进行解调后获得航向误差和俯仰角误差。
步骤五、通过姿态融合模块对三轴角速度变化、加速度变化和卫星信号 强度进行姿态融合,得到姿态的估算值。
步骤六、通过姿态的估算值控制天线电机对卫星进行跟踪,再将跟踪卫 星检测的信号强度信息反馈至姿态融合模块进行姿态融合,形成闭环。
其中三轴磁力计采用Metrolab TFM1186三轴磁力计。三轴加速度传感 器采用ADXL335BCPZ加速度传感器、LIS3DH三轴加速度计或 MMA7455LR1三轴加速度计。三轴陀螺仪采用MEMS陀螺仪。
采用上述方法时可随时进行航向修正,提高航向角估算准确度;因此与 现有技术在载体静止或低速时导航信息不可靠相比,本方法中无论载体是 否运动,反馈的卫星信号信息都是可靠的,姿态估算更准确。
同时可以减少设备,降低对硬件的要求,节约成本。现有技术需要导航 设备来修正姿态,而本发明中利用动中通本身的卫星信号信息修正姿态,无 需另外添加导航设备。
现有技术对整体动中通控制***而言是开环控制,要求惯导估算准确的 姿态;而本发明因融合卫星信号信息,形成闭环控制,降低对惯导姿态估算 准确度的要求。
本发明一种组合惯导姿态计算方法,通过第一姿态作为三轴陀螺仪的初 始姿态,通过姿态融合包括第一姿态,提高导航精度和可靠性实现各种环境 下的准确导航。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限 于此,任何熟悉本领域技术的技术人员在本发明公开的技术范围内,可轻易 想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的 保护范围应以所述权利要求的保护范围为准。
Claims (6)
1.一种组合惯导姿态计算方法,其特征在于,包括如下步骤:
步骤一、在第一采样周期,通过三轴加速度传感器采集载体x轴、y轴和z轴的第一加速度数据,通过三轴磁力计采集载体x轴、y轴和z轴的磁力计数据;
步骤二、根据磁力计数据和所述第一加速度计数据计算第一姿态,第一姿态发送至姿态融合模块,所述第一姿态作为三轴陀螺仪的初始姿态;
步骤三、在第二采样周期,通过三轴陀螺传感器采集载体x轴、y轴和z轴的角速度,并对角速度积分获得三轴角度变化;三轴加速度传感器采集载体x轴、y轴和z轴的加速度,获得加速度变化;
步骤四、通过卫星信号强度检测模块对天线束波指向卫星方向的信号强度进行检测,并对信号强度进行解调后获得航向误差和俯仰角误差;
步骤五、通过姿态融合模块对三轴角速度变化、加速度变化和卫星信号强度进行姿态融合,得到姿态的估算值;
步骤六、通过姿态的估算值控制天线电机对卫星进行跟踪,再将跟踪卫星检测的信号强度信息反馈至姿态融合模块进行姿态融合,形成闭环。
2.根据权利要求1所述一种组合惯导姿态计算方法,其特征在于,所述三轴磁力计采用Metrolab TFM1186三轴磁力计。
3.根据权利要求1所述一种组合惯导姿态计算方法,其特征在于,所述三轴加速度传感器采用ADXL335BCPZ加速度传感器。
4.根据权利要求1所述一种组合惯导姿态计算方法,其特征在于,所述三轴加速度传感器采用LIS3DH三轴加速度计。
5.根据权利要求1所述一种组合惯导姿态计算方法,其特征在于,所述三轴加速度传感器采用MMA7455LR1三轴加速度计。
6.根据权利要求1所述一种组合惯导姿态计算方法,其特征在于,所述三轴陀螺仪采用MEMS陀螺仪。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911267984.9A CN111006660A (zh) | 2019-12-11 | 2019-12-11 | 一种组合惯导姿态计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911267984.9A CN111006660A (zh) | 2019-12-11 | 2019-12-11 | 一种组合惯导姿态计算方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111006660A true CN111006660A (zh) | 2020-04-14 |
Family
ID=70114306
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911267984.9A Pending CN111006660A (zh) | 2019-12-11 | 2019-12-11 | 一种组合惯导姿态计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111006660A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112325841A (zh) * | 2020-10-26 | 2021-02-05 | 中国电子科技集团公司第五十四研究所 | 一种动中通天线安装误差角的估计方法 |
CN113701751A (zh) * | 2021-08-24 | 2021-11-26 | 西安大衡天成信息科技有限公司 | 一种基于多波束天线的导航装置 |
CN113805201A (zh) * | 2021-09-17 | 2021-12-17 | 中科海微(北京)科技有限公司 | 一种天线姿态的检测设备及方法 |
CN114283598A (zh) * | 2021-12-06 | 2022-04-05 | 上海今隶智能科技有限公司 | 一种交通信号灯的监控方法及装置 |
CN115813332A (zh) * | 2023-02-17 | 2023-03-21 | 成都信和创业科技有限责任公司 | 一种模拟眼球运动的眼动仪检测装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7587277B1 (en) * | 2005-11-21 | 2009-09-08 | Miltec Corporation | Inertial/magnetic measurement device |
CN105628024A (zh) * | 2015-12-29 | 2016-06-01 | 中国电子科技集团公司第二十六研究所 | 基于多传感器融合的单人定位导航器和定位导航方法 |
CN106767786A (zh) * | 2016-12-27 | 2017-05-31 | 成都国卫通信技术有限公司 | 基于卫星通信的组合惯导姿态计算方法 |
US20170350721A1 (en) * | 2015-10-13 | 2017-12-07 | Shanghai Huace Navigation Technology Ltd | Method of Updating All-Attitude Angle of Agricultural Machine Based on Nine-Axis MEMS Sensor |
CN108571980A (zh) * | 2017-03-07 | 2018-09-25 | 深圳市博安智控科技有限公司 | 一种捷联惯性导航的误差校正方法及装置 |
-
2019
- 2019-12-11 CN CN201911267984.9A patent/CN111006660A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7587277B1 (en) * | 2005-11-21 | 2009-09-08 | Miltec Corporation | Inertial/magnetic measurement device |
US20170350721A1 (en) * | 2015-10-13 | 2017-12-07 | Shanghai Huace Navigation Technology Ltd | Method of Updating All-Attitude Angle of Agricultural Machine Based on Nine-Axis MEMS Sensor |
CN105628024A (zh) * | 2015-12-29 | 2016-06-01 | 中国电子科技集团公司第二十六研究所 | 基于多传感器融合的单人定位导航器和定位导航方法 |
CN106767786A (zh) * | 2016-12-27 | 2017-05-31 | 成都国卫通信技术有限公司 | 基于卫星通信的组合惯导姿态计算方法 |
CN108571980A (zh) * | 2017-03-07 | 2018-09-25 | 深圳市博安智控科技有限公司 | 一种捷联惯性导航的误差校正方法及装置 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112325841A (zh) * | 2020-10-26 | 2021-02-05 | 中国电子科技集团公司第五十四研究所 | 一种动中通天线安装误差角的估计方法 |
CN112325841B (zh) * | 2020-10-26 | 2022-05-27 | 中国电子科技集团公司第五十四研究所 | 一种动中通天线安装误差角的估计方法 |
CN113701751A (zh) * | 2021-08-24 | 2021-11-26 | 西安大衡天成信息科技有限公司 | 一种基于多波束天线的导航装置 |
CN113701751B (zh) * | 2021-08-24 | 2024-05-07 | 西安大衡天成信息科技有限公司 | 一种基于多波束天线的导航装置 |
CN113805201A (zh) * | 2021-09-17 | 2021-12-17 | 中科海微(北京)科技有限公司 | 一种天线姿态的检测设备及方法 |
CN114283598A (zh) * | 2021-12-06 | 2022-04-05 | 上海今隶智能科技有限公司 | 一种交通信号灯的监控方法及装置 |
CN115813332A (zh) * | 2023-02-17 | 2023-03-21 | 成都信和创业科技有限责任公司 | 一种模拟眼球运动的眼动仪检测装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111006660A (zh) | 一种组合惯导姿态计算方法 | |
US10416276B2 (en) | Position tracking system and method using radio signals and inertial sensing | |
US11175375B2 (en) | Position tracking system and method using radio signals and inertial sensing | |
CN105628026B (zh) | 一种移动物体的定位定姿方法和*** | |
CN110764119B (zh) | 不依赖于卫星导航信息的卫星天线自主测控方法及*** | |
CN106767786A (zh) | 基于卫星通信的组合惯导姿态计算方法 | |
CA2933558C (en) | Methods and apparatus for determining angle of arrival (aoa) in a radar warning receiver | |
CA2802445C (en) | Moving platform ins range corrector (mpirc) | |
CN104764452A (zh) | 一种基于惯性和光学跟踪***的混合位姿跟踪方法 | |
CA2733032C (en) | Method and apparatus for improved navigation of a moving platform | |
KR101878685B1 (ko) | 지도 정보를 이용한 차량 측위 시스템 및 방법 | |
US20230333572A1 (en) | Methods and systems for estimating the orientation of an object | |
CA2989529C (en) | Positioning apparatus | |
WO2017029042A1 (en) | Antenna pattern data mining for automotive global navigation satellite system receivers | |
KR101498940B1 (ko) | 신호 송수신 상황에 기반한 빔 포밍 장치 및 방법 | |
CN104880189A (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
US10162410B1 (en) | Head tracker for dismounted users | |
KR101629691B1 (ko) | 관성 센서를 이용한 실내 측위 시스템 | |
Zeng et al. | Infrastructure-free indoor pedestrian tracking based on foot mounted UWB/IMU sensor fusion | |
CN106370182A (zh) | 一种个人组合导航方法 | |
KR101387665B1 (ko) | 초기정렬 주행 시스템 | |
CN113794497B (zh) | 一种具有抗干扰定位功能的移动卫星通信天线终端 | |
CN202649469U (zh) | 有效全球卫星定位***所在位置判断的定位装置 | |
CN113419265B (zh) | 一种基于多传感器融合的定位方法、装置与电子设备 | |
US20100214164A1 (en) | Longitudinal and Lateral Velocity Estimation Using Single Antenna GPS and Magnetic Compass |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200414 |