CN102901977A - 一种飞行器的初始姿态角的确定方法 - Google Patents
一种飞行器的初始姿态角的确定方法 Download PDFInfo
- Publication number
- CN102901977A CN102901977A CN2012104137894A CN201210413789A CN102901977A CN 102901977 A CN102901977 A CN 102901977A CN 2012104137894 A CN2012104137894 A CN 2012104137894A CN 201210413789 A CN201210413789 A CN 201210413789A CN 102901977 A CN102901977 A CN 102901977A
- Authority
- CN
- China
- Prior art keywords
- aircraft
- attitude angle
- angle
- information
- attitude
- 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
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
Description
技术领域
本发明涉及一种姿态角确定方法。
背景技术
小型高动态飞行器(以下简称飞行器)在空中加电后,需导航***自主辨识出初始姿态信息,完成空中定姿,才能进行后续导航计算。但由于存在着高过载、小体积的特点,故飞行器的空中定姿只能采用MEMS器件来完成。但是MEMS惯性器件存在漂移大、精度低等缺点。
目前国内文章采用地磁方法进行空中姿态辨识。如中北大学的曹红松等人提出了地磁传感芯片和硅微陀螺构建低成本姿态探测***,在仿真条件下可以得到较高精度的姿态信息(见《弹箭与制导学报》2006年第三期的《地磁陀螺组合弹药姿态技术研究》)。但该方法需要三轴地磁信息和两个先验姿态信息才能完成第三姿态角计算,计算复杂。且测量精度受制于多个传感器精度的影响,另外该方法地磁利用三轴地磁信息,定姿的精度受到传感器本身因素的影响,使用条件高。
利用GPS测量姿态,利用GPS载波相位进行空中定姿,由于该方法需要两个以上的天线才能定姿,而且基线长度要有一定的距离,故该方法一般适用于空间较大的飞行器进行空间定姿,对于小型飞行器不适用(见2008年南京航空航天大学的李雪涛的博士论文《双天线GPS/SINS组合导航***研究》)。
发明内容
本发明所要解决的技术问题是针对小型飞行器空中自对准的要求提供一种成本低、方法简单、精度高的初始姿态角的确定方法,能够实现小型飞行器的空中姿态测量。
本发明包括如下技术方案:
一种飞行器的初始姿态角的确定方法,包括如下步骤:
根据双轴地磁传感器输出的信号获得地磁信息My1和Mz1;
根据如下公式计算滚动姿态角γ;
其中,a、β为飞行器当前位置的磁偏角和磁倾角。
所述GPS接收机获得的速度信息包括北向、天向、东向速度vN、vU、vE,
其中A0为导航坐标系方位角。
对双轴地磁传感器输出的信号进行零位补偿和比例系数补偿获得地磁信息My1和Mz1。
本发明与现有技术相比具有如下优点:
1)为降低成本,飞行器的姿态测量多采用MEMS惯组,其中MEMS惯组零偏大,且受发射过载冲击影响大;而本发明的方法仅需GPS接收机和双轴地磁传感器实现,该器件受小型飞行器发射过载影响小;规避了对惯组的依赖,适应性强;
2)传统的空中对准方法依赖的条件较多,比如传统的基于Kalman滤波的空中对准方法需要飞行器进行长时间的横向机动,利用INS积分的速度位置信息与GPS接收机定位速度位置信息进行最优估计,获取弹体姿态信息。而本发明的方法不依赖任何其他先验弹道信息,也无需飞行器进行横向机动,只需提供双轴地磁信息、GPS信息、三个地磁参数就可以获得三个姿态信息,从而完成空中对准。本方法不但简单,而且实时性高,也不存在算法收敛问题,易于工程实现。
3)本发明基于双轴地磁传感器和GPS进行空中定姿的方法,该方法无需惯性器件就能进行空中定姿的方法,这样可以大大降低成本,而且也能提高精度。该方法采用飞行器截面双轴上地磁信息相除运算就获得滚转角,该方法简单,而且有效地减少多种磁干扰。
附图说明
图1为本发明的姿态角确定方法的流程图。
具体实施方式
下面就结合附图对本发明做进一步介绍。
由于小型飞行器在空中加电后,无法获取弹体初始姿态信息,需要通过控制***进行空中定姿,由于GPS可以获得北东天坐标系下的三方向速度vN、vU、vE。随着器件水平的提高,GPS接收机解算速度及数据刷新率也不断提高,目前GPS接收机数据刷新频率能够达到10~100Hz,一般来说GPS接收机定位速度偏差很小,约在0.2m/s以内,本发明利用GPS接收机定位相对速度比较准确的特点,来获得初始俯仰姿态角、偏航姿态角信息。而初始滚转姿态角信息必然会叠加在双轴地磁信息上,故通过地磁信息、GPS获得初始姿态信息、地磁场基本参数即可得到初始滚转角信息。
如图1所示,本发明的具体实现步骤如下:
选用的GPS接收机为单天线的普通接收机,通过GPS定位的北向、天向、东向速度vN、vU、vE计算得到俯仰姿态角和偏航姿态角,其中
ψ=A0-tan-1(vE/vN)tan-1(vE/vN)∈[0,2π],ψ∈[-π,π]
其中A0为导航坐标系方位角,其计算方法属于公知技术。
2)通过双轴地磁传感器获得地磁信息My1和Mz1
双轴地磁传感器使用的是微机械磁阻传感器,可以直接输出地磁信号,设地磁传感器敏感的信息为By1,Bz1,可以对By1,Bz1进行地磁信息零位补偿和比例系数补偿;补偿方法如下:
零位补偿:
By1、Bz1为飞行器体系坐标系下y1,z1轴向的地磁信息,该坐标系定义如下:原点位于飞行器质心,x1轴与飞行器纵轴重合,指向头部为正;y1轴位于飞行器纵向对称面内与x1轴垂直,向上为正,z1轴垂直于x1和y1轴,按照右手坐标系法则确定。
By1_max,By1_min为飞行器自身旋转一周内,y向输出的最大和最小磁信号。同理z向也如此。
比例系数补偿:
My1和Mz1分别为经过补偿后的飞行器体系坐标系下的y、z轴的地磁分量。
经过上述补偿后地磁信息可以去除大部分的磁干扰,得到一定精度的磁信息。
3)计算滚动姿态角γ
弹体系地磁信息与导航系的地磁信息的关系如下:
其中S为弹体与导航系的姿态转移矩阵,
由上式可知:
其中B为飞行器当前位置的地磁总量,a、β为飞行器当前位置的磁偏角和磁倾角。
根据公式(4)可以确定出滚动姿态角的计算公式:
本发明未详细说明部分属本领域技术人员公知常识。
Claims (3)
3.如权利要求1所述的方法,其特征在于:对双轴地磁传感器输出的信号进行零位补偿和比例系数补偿获得地磁信息My1和Mz1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210413789.4A CN102901977B (zh) | 2012-10-24 | 2012-10-24 | 一种飞行器的初始姿态角的确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210413789.4A CN102901977B (zh) | 2012-10-24 | 2012-10-24 | 一种飞行器的初始姿态角的确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102901977A true CN102901977A (zh) | 2013-01-30 |
CN102901977B CN102901977B (zh) | 2014-07-02 |
Family
ID=47574316
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210413789.4A Active CN102901977B (zh) | 2012-10-24 | 2012-10-24 | 一种飞行器的初始姿态角的确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102901977B (zh) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105403218A (zh) * | 2015-12-08 | 2016-03-16 | 北京健德乾坤导航***科技有限责任公司 | 用于四旋翼无人机的俯仰角的地磁修正方法 |
CN105446355A (zh) * | 2015-12-10 | 2016-03-30 | 深圳市道通智能航空技术有限公司 | 自动返航方法、***及无人机 |
CN106403932A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载地磁姿态测量处理算法的验证方法 |
CN106403934A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载地磁姿态测量处理算法 |
CN106441301A (zh) * | 2016-09-19 | 2017-02-22 | 北京机械设备研究所 | 一种飞行器发射初始参数获取方法及*** |
CN106556852A (zh) * | 2016-11-21 | 2017-04-05 | 重庆卓观科技有限公司 | 一种基于定位姿态信息模拟磁罗盘的方法与磁强计模拟器 |
CN106918828A (zh) * | 2017-04-21 | 2017-07-04 | 中仿智能科技(上海)股份有限公司 | 一种飞行器自主导航方法及*** |
CN107202598A (zh) * | 2017-07-31 | 2017-09-26 | 中国工程物理研究院电子工程研究所 | 一种用于测试卫星接收机和地磁模块组合导航***的地面测试平台及测试方法 |
CN110095121A (zh) * | 2019-04-10 | 2019-08-06 | 北京微克智飞科技有限公司 | 一种抗机体磁干扰的无人机航向解算方法和*** |
CN110132268A (zh) * | 2019-06-10 | 2019-08-16 | 西北工业大学 | 一种车载飞行器初始姿态获取方法 |
CN111912402A (zh) * | 2020-07-22 | 2020-11-10 | 北京自动化控制设备研究所 | 基于地磁信息辅助gps的高旋转载体的测姿方法及装置 |
CN113551663A (zh) * | 2021-06-21 | 2021-10-26 | 北京理工大学 | 图像与地磁组合的飞行器姿态解算***及方法 |
CN116538382A (zh) * | 2023-07-03 | 2023-08-04 | 山东水发黄水东调工程有限公司 | 输水管道内巡检机器人及其控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3763435B2 (ja) * | 1998-01-20 | 2006-04-05 | Necトーキン株式会社 | 姿勢角検出装置 |
JP2007183138A (ja) * | 2006-01-05 | 2007-07-19 | Kenzo Nonami | 小型姿勢センサ |
CN101093397A (zh) * | 2006-06-23 | 2007-12-26 | 航天东方红卫星有限公司 | 基于星上网的卫星姿态和轨道控制*** |
CN101554926A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 航天器的姿态控制***及方法 |
CN101846510A (zh) * | 2010-05-28 | 2010-09-29 | 北京航空航天大学 | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 |
-
2012
- 2012-10-24 CN CN201210413789.4A patent/CN102901977B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3763435B2 (ja) * | 1998-01-20 | 2006-04-05 | Necトーキン株式会社 | 姿勢角検出装置 |
JP2007183138A (ja) * | 2006-01-05 | 2007-07-19 | Kenzo Nonami | 小型姿勢センサ |
CN101093397A (zh) * | 2006-06-23 | 2007-12-26 | 航天东方红卫星有限公司 | 基于星上网的卫星姿态和轨道控制*** |
CN101554926A (zh) * | 2009-05-20 | 2009-10-14 | 上海微小卫星工程中心 | 航天器的姿态控制***及方法 |
CN101846510A (zh) * | 2010-05-28 | 2010-09-29 | 北京航空航天大学 | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105403218B (zh) * | 2015-12-08 | 2018-12-21 | 北京天龙智控科技有限公司 | 用于四旋翼无人机的俯仰角的地磁修正方法 |
CN105403218A (zh) * | 2015-12-08 | 2016-03-16 | 北京健德乾坤导航***科技有限责任公司 | 用于四旋翼无人机的俯仰角的地磁修正方法 |
CN105446355A (zh) * | 2015-12-10 | 2016-03-30 | 深圳市道通智能航空技术有限公司 | 自动返航方法、***及无人机 |
WO2017096683A1 (zh) * | 2015-12-10 | 2017-06-15 | 深圳市道通智能航空技术有限公司 | 自动返航方法、***及无人机 |
CN105446355B (zh) * | 2015-12-10 | 2018-06-26 | 深圳市道通智能航空技术有限公司 | 自动返航方法、***及无人机 |
CN106403932A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载地磁姿态测量处理算法的验证方法 |
CN106403934A (zh) * | 2016-08-24 | 2017-02-15 | 易文俊 | 一种弹载地磁姿态测量处理算法 |
CN106403932B (zh) * | 2016-08-24 | 2019-07-23 | 易文俊 | 一种弹载地磁姿态测量处理算法的验证方法 |
CN106403934B (zh) * | 2016-08-24 | 2019-04-09 | 易文俊 | 一种弹载地磁姿态测量处理方法 |
CN106441301A (zh) * | 2016-09-19 | 2017-02-22 | 北京机械设备研究所 | 一种飞行器发射初始参数获取方法及*** |
CN106556852A (zh) * | 2016-11-21 | 2017-04-05 | 重庆卓观科技有限公司 | 一种基于定位姿态信息模拟磁罗盘的方法与磁强计模拟器 |
CN106918828A (zh) * | 2017-04-21 | 2017-07-04 | 中仿智能科技(上海)股份有限公司 | 一种飞行器自主导航方法及*** |
CN107202598A (zh) * | 2017-07-31 | 2017-09-26 | 中国工程物理研究院电子工程研究所 | 一种用于测试卫星接收机和地磁模块组合导航***的地面测试平台及测试方法 |
CN110095121A (zh) * | 2019-04-10 | 2019-08-06 | 北京微克智飞科技有限公司 | 一种抗机体磁干扰的无人机航向解算方法和*** |
CN110095121B (zh) * | 2019-04-10 | 2021-07-30 | 北京微克智飞科技有限公司 | 一种抗机体磁干扰的无人机航向解算方法和*** |
CN110132268A (zh) * | 2019-06-10 | 2019-08-16 | 西北工业大学 | 一种车载飞行器初始姿态获取方法 |
CN111912402A (zh) * | 2020-07-22 | 2020-11-10 | 北京自动化控制设备研究所 | 基于地磁信息辅助gps的高旋转载体的测姿方法及装置 |
CN111912402B (zh) * | 2020-07-22 | 2022-09-09 | 北京自动化控制设备研究所 | 基于地磁信息辅助gps的高旋转载体的测姿方法及装置 |
CN113551663A (zh) * | 2021-06-21 | 2021-10-26 | 北京理工大学 | 图像与地磁组合的飞行器姿态解算***及方法 |
CN113551663B (zh) * | 2021-06-21 | 2024-03-19 | 北京理工大学 | 图像与地磁组合的飞行器姿态解算***及方法 |
CN116538382A (zh) * | 2023-07-03 | 2023-08-04 | 山东水发黄水东调工程有限公司 | 输水管道内巡检机器人及其控制方法 |
CN116538382B (zh) * | 2023-07-03 | 2023-11-07 | 山东水发黄水东调工程有限公司 | 输水管道内巡检机器人及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102901977B (zh) | 2014-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102901977B (zh) | 一种飞行器的初始姿态角的确定方法 | |
CN105628026B (zh) | 一种移动物体的定位定姿方法和*** | |
CN106556854B (zh) | 一种室内外导航***及方法 | |
CN106772493B (zh) | 基于北斗差分定位的无人机航向测算***及其测算方法 | |
CN105652306A (zh) | 基于航迹推算的低成本北斗与mems紧耦合定位***及方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
CN104121905A (zh) | 一种基于惯性传感器的航向角获取方法 | |
CN106255065A (zh) | 智能手机和移动终端室内外无缝定位***及其方法 | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航***的目标导航测绘方法 | |
CN110779496B (zh) | 三维地图构建***、方法、设备和存储介质 | |
CN103196445A (zh) | 基于匹配技术的地磁辅助惯性的载体姿态测量方法 | |
CN110617795B (zh) | 一种利用智能终端的传感器实现室外高程测量的方法 | |
CN114739425A (zh) | 基于rtk-gnss及全站仪的采煤机定位标定***及应用方法 | |
CN105301621A (zh) | 一种车辆定位装置及一种智能驾考*** | |
CN111288983B (zh) | 一种适于多源融合的室内狭长地带定位方法 | |
CN102901485A (zh) | 一种光电经纬仪快速自主定向的方法 | |
US20140249750A1 (en) | Navigational and location determination system | |
CN113325455B (zh) | 用于跟踪和确定物体的室内位置的方法和*** | |
Wang et al. | Land vehicle navigation using odometry/INS/vision integrated system | |
Zhang et al. | Mag-ODO: Motion speed estimation for indoor robots based on dual magnetometers | |
CN101644769A (zh) | 获取物体三维运动轨迹方法 | |
CN206281978U (zh) | 一种gnss接收机航向角的测试*** | |
CN111189446A (zh) | 一种基于无线电的组合导航方法 | |
CN202837553U (zh) | 距离及方向校正的位置估测装置 | |
CN114877881A (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 |