CN100557540C - 一种基于磁航向传感器的无人机航向自动修正方法 - Google Patents
一种基于磁航向传感器的无人机航向自动修正方法 Download PDFInfo
- Publication number
- CN100557540C CN100557540C CNB2007103041770A CN200710304177A CN100557540C CN 100557540 C CN100557540 C CN 100557540C CN B2007103041770 A CNB2007103041770 A CN B2007103041770A CN 200710304177 A CN200710304177 A CN 200710304177A CN 100557540 C CN100557540 C CN 100557540C
- Authority
- CN
- China
- Prior art keywords
- magnetic
- heading angle
- aircraft
- course
- unmanned plane
- 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
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于磁航向传感器的无人机航向自动修正方法，可应用于自主起降型无人机的航向自动修正。通过两个地标点的经纬度信息获得真航向角，通过磁航向传感器获得磁航向角，得到机场所在地的磁差，实时计算飞机飞行和起降过程中的真航向角。本发明提供的方法原理简单，不需差磁差图，对于无人机操控人员所需了解的信息量降低，操控流程简化。
Description
技术领域
本发明属于无人机飞行控制领域，具体地说是指一种基于磁航向传感器的无人机航向自动修正技术。
背景技术
飞机的航向角是指飞机纵轴的水平投影线与水平面上某一基准线之间的夹角。根据所取的基准线不同，可以将航向角分为真航向角、磁航向角、罗航向角、大圆航向角和陀螺航向角等等。其中，真子午线与飞机纵轴在水平面上投影线的夹角称为真航向角，是用来确定飞机航向并参与闭环控制的重要飞行参数，尤其是针对于自主起降式无人机，在飞机起降阶段需要高精度的真航向角信息来控制飞机对准跑道飞/滑行。因此，如何得到实时准确的真航向角信息是无人机飞行控制系统设计中需要面对的问题。
磁航向传感器是测量地磁航向角的有效手段，具有体积小、重量轻、安装易、能耗低等特点。磁航向传感器通过磁敏感元件感受传感器本身三个轴线方向的地磁分量并输出，根据这三个地磁分量，加上飞机的姿态信息，则可以得到飞机的磁航向角。
所谓磁航向角，指的是磁子午线与飞机纵轴在水平面上的夹角。由于磁子午线与真子午线方向并不一致，磁航向角并不是真航向角，磁航向角与真航向角之间的偏差称之为磁差。另外，由于飞机上存在着铁磁场和电磁场，当磁航向传感器装上飞机之后，测得的磁分量受到这些磁场的干扰，则会出现罗差。实际的磁航向传感器输出的信息量是加上罗差影响的磁航向角，即罗航向角。附图1中给出了真航向角、磁航向角及罗航向角的关系示意图，真航向角加磁差值就等于磁航向角。
不同的飞机，其罗差值是不相同的，而且由于飞机磁场的大小和方向随飞机转动而变化，同一飞机的不同航向上的罗差值也不相同。即便如此，罗差是可以通过校验试验消除其影响的，这在很多相关文献中都可以找到试验的方法。而地球磁差随着时间、地点的不同而对罗差造成不同的影响，以往的飞行过程中，某一地点的磁差是通过查磁差图来获得的，在每次飞行时都需要查图获得飞机起飞或降落地点的磁差值，并通过测控链路来装订该数据，利用磁航向角与磁差值做差得到飞机的真航向角，流程繁琐，操控人员的工作量大。
发明内容
本发明的目的是提出一种基于磁航向传感器的无人机航向自动修正方法，通过该方法能够在飞机所在地磁差未知的情况下，通过无人机航向自动修正方法来得到真航向角，并作为有效的传感器反馈信息应用于飞行控制系统。
应用本发明提供的修正方法首先在飞行前将飞机沿跑道中心线放置，根据跑道上的两个地标点经纬度信息以及安装于飞机上的磁航向传感器输出信息得到磁差值，并将此磁差值作为常量装订到飞控计算机，通过磁差值和磁航向角计算飞机的真航向角，具体包括如下步骤：
步骤一：首先将飞机沿跑道中心线放置，使飞机机体纵轴与跑道中心线尽量重合。
步骤二：飞机收到“起飞”指令时，机载飞控计算机根据地标点1和地标点2的经纬度信息解算飞机此时的原始真航向角ψ0。
步骤三：通过机上磁航向传感器得到飞机的磁航向角ψ1，根据原始真航向角ψ0以及从磁航向传感器上接收到的磁航向角ψ1计算磁差值Δψ。
步骤四：机载飞控计算机将磁航向角ψ1与该磁差值Δψ相减，得到飞机的真航向角ψ：飞机根据真航向角ψ开始起飞。
步骤五：在后续的飞行及着陆过程中，重复步骤四，实时的接收磁航向角ψ1并计算真航向角ψ，使飞机以真航向角ψ进行飞行和降落。
步骤四或者步骤五中得到的飞机真航向角ψ将通过测控链路下传显示，供操控人员监控参考，并参与飞行控制回路。
本发明的无人机航向自动修正方法的优点是：
(1)该修正方法无需查磁差图获得当地磁差，减少人为误差；
(2)对于无人机操控人员所需了解的信息量降低，操控流程简化。
附图说明
图1是真航向角、磁航向角及罗航向角的关系示意图；
图2是本发明中实现航向自动修正的原理示意图。
具体实施方式
下面将结合附图对本发明作进一步的详细说明。
本发明涉及一种基于磁航向传感器的无人机航向自动修正方法。根据跑道上的两个地标点经纬度信息以及安装于飞机上的磁航向传感器输出信息得到磁差值，通过磁差值和磁航向角信息计算得到飞机的真航向角。
自主起降型无人机的飞行需要根据实际的机场位置来定制相应的起降航向，也就是真航向，此时必然需要在跑道中心线上选取两个位置点作为参考。这两点的经纬度信息可以通过严格的标定得到，并分别称为地标点1和地标点2。根据这两地标点的经纬度信息，可以解算出跑道中心线与正北方向的夹角，即跑道中心线与真子午线之间的夹角-真航向角，真航向角、磁差和磁航向角之间的关系图如图2所示，磁航向角减去磁差就得到真航向角。此时，若将飞机沿跑道中心线放置，飞机上安装的磁航向传感器所测得的磁航向角ψ1与根据两个地标点经纬度信息解算出的原始真航向角ψ0之差即为当地磁差值Δψ。飞行过程中，在一定的飞行范围内，此磁差值Δψ的数值变化并不会很大，并且，自主起降型无人机通常起降于同一机场，其具有精确真航向角ψ需求的阶段为飞行的起降阶段，因此根据起飞前得到的磁差值Δψ可以对无人机的真航向角进行不断修正。本发明提供的一种基于磁航向传感器的无人机航向自动修正方法是按照以下步骤实现的：
步骤一：首先将飞机沿跑道中心线放置，使飞机机体纵轴与跑道中心线尽量重合，如图2所示的是本发明提供方法的原理图。跑道的中心线上有两个地标点1和地标点2，地标点1和地标点2的连线即为跑道的中心线。
步骤二：飞机收到“起飞”指令时，机载飞控计算机根据地标点1和地标点2的经纬度信息解算飞机此时的原始真航向角ψ0。
设原始真航向角为ψ0，ψ0∈[-π，π]，地标点2的经度为L0，纬度为B0，地标点1的经度为L1，纬度为B1，地标点1在地球坐标系中的天向分量为k1，地标点2在地球坐标系中的天向分量为k0，地标点2在地球坐标系中的北向分量为j0，则
k0＝[cosB0·cosL0，cosB0·sinL0，sinB0]′
k1＝[cosB1·cosL1，cosB1·sinL1，sinB1]′
j0＝[-sinB0·cosL0，-sinB0·sinL0，cosB0]′
步骤三：通过机上磁航向传感器得到飞机的磁航向角ψ1，根据原始真航向角ψ0以及从磁航向传感器上获得的磁航向角ψ1计算磁差值Δψ。
Δψ＝ψ1-ψ0
步骤四：通过磁航向传感器实时的获得磁航向角，机载飞控计算机将磁航向角ψ1与磁差Δψ相减，得到飞机的真航向角ψ：
ψ＝ψ1-Δψ
飞机根据真航向角ψ开始起飞。
步骤五：在后续的飞行及着陆过程中，重复步骤四，实时的获得磁航向角ψ1并计算真航向角ψ，使飞机以真航向角ψ进行飞行和降落。
步骤四或者步骤五中得到的飞机真航向角ψ将通过测控链路下传显示，供操控人员监控参考，并参与飞行控制回路。
从上述的磁航向修正方法中可以看出，在进行真航向角的计算时，只需要用磁航向角减去磁差即可，而因为飞机的起飞和降落是在同一个机场即可以认为飞机起飞和降落时的磁差值是相等的，因此飞机起飞和降落的过程中直接根据飞机上磁航向传感器测得的磁航向角与起飞前获得的磁差值来实时得到飞机不同飞行状态的真航向角。该修正方法原理简单，方便有效，无需查磁差图获得当地磁差，并且对无人机操控人员所需了解的信息量降低，操控流程简化。
Claims (2)
1、一种基于磁航向传感器的无人机航向自动修正方法，其特征在于包括以下步骤：
步骤一：首先将飞机沿跑道中心线放置，使飞机机体纵轴与跑道中心线尽量重合；
步骤二：飞机收到“起飞”指令时，机载飞控计算机根据地标点1和地标点2的经纬度信息解算飞机此时的原始真航向角ψ0；
步骤三：通过机上磁航向传感器得到飞机的磁航向角ψ1，计算磁差值Δψ；
步骤四：机载飞控计算机将磁航向角ψ1与该磁差值Δψ相减，得到飞机的真航向角ψ，飞机根据真航向角ψ开始起飞；
步骤五：在后续的飞行及着陆过程中，重复步骤四，实时地接收磁航向角ψ1并计算真航向角ψ，使飞机以真航向角ψ进行飞行和降落。
2、根据权利要求1所述的一种基于磁航向传感器的无人机航向自动修正方法，其特征在于：
步骤二中所述的地标点1和地标点2的连线与跑道中心线重合。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB2007103041770A CN100557540C (zh) | 2007-12-25 | 2007-12-25 | 一种基于磁航向传感器的无人机航向自动修正方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CNB2007103041770A CN100557540C (zh) | 2007-12-25 | 2007-12-25 | 一种基于磁航向传感器的无人机航向自动修正方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN101201627A CN101201627A (zh) | 2008-06-18 |
| CN100557540C true CN100557540C (zh) | 2009-11-04 |
Family
ID=39516820
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CNB2007103041770A Expired - Fee Related CN100557540C (zh) | 2007-12-25 | 2007-12-25 | 一种基于磁航向传感器的无人机航向自动修正方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN100557540C (zh) |
Families Citing this family (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102156480A (zh) * | 2010-12-30 | 2011-08-17 | 清华大学 | 基于自然地标和视觉导航的无人直升机自主着陆方法 |
| CN102650887A (zh) * | 2011-02-25 | 2012-08-29 | 鸿富锦精密工业（深圳）有限公司 | 无人飞行载具及调整其控制信号的方法 |
| CN102426016B (zh) * | 2011-09-01 | 2014-09-17 | 中国航空工业第六一八研究所 | 一种基于惯性导航综合航路管理的实现方法 |
| CN102722176B (zh) * | 2012-06-18 | 2014-06-04 | 中国航天空气动力技术研究院 | 一种可变形无人机飞行控制方法 |
| CN103322965B (zh) * | 2013-06-05 | 2015-09-30 | 哈尔滨工程大学 | 一种惯性导航系统横卯酉面曲率半径测量方法 |
| CN103823366B (zh) * | 2014-02-28 | 2016-05-04 | 西安费斯达自动化工程有限公司 | 纵向飞行模型簇复合根轨迹补偿控制器设计方法 |
| CN104267736B (zh) * | 2014-09-11 | 2017-05-17 | 中智科创机器人有限公司 | 一种帆船自主控制方法、装置及帆船 |
| CN104503466B (zh) * | 2015-01-05 | 2017-09-12 | 北京健德乾坤导航系统科技有限责任公司 | 一种微小型无人机导航装置 |
| CN105759609B (zh) * | 2016-02-29 | 2018-05-11 | 北京航空航天大学 | 一种基于显式非线性模型预测控制的舰载机自主着舰方法 |
| CN108521806B (zh) * | 2017-05-23 | 2019-11-08 | 深圳市大疆创新科技有限公司 | 一种航向修正方法、设备及飞行器 |
| CN109115241A (zh) * | 2018-08-07 | 2019-01-01 | 中国航空无线电电子研究所 | 飞机航向数据源完好性监控方法 |
| CN111127955B (zh) * | 2019-11-28 | 2021-05-04 | 中国航空工业集团公司西安航空计算技术研究所 | 一种飞行计划航段自动激活方法 |
| CN111122900B (zh) * | 2019-12-19 | 2021-09-07 | 珠海翔翼航空技术有限公司 | 一种磁差修正方法及装置 |
| CN112595317B (zh) * | 2020-10-26 | 2024-05-24 | 一飞(海南)科技有限公司 | 无人机起飞控制方法、系统、介质、计算机设备、无人机 |
| CN114184184A (zh) * | 2021-12-08 | 2022-03-15 | 国营芜湖机械厂 | 一种飞机磁罗盘的罗差校准方法 |
-
2007
- 2007-12-25 CN CNB2007103041770A patent/CN100557540C/zh not_active Expired - Fee Related
Non-Patent Citations (2)
| Title |
|---|
| 无人机磁航向测量的自动罗差补偿研究. 刘诗斌.航空学报，第Vol.28卷第No.2期. 2007 * |
| 磁航向传感器在无人机飞行控制系统中的应用. 刘歌群，薛尧舜，卢京潮，闫建国.传感器技术，第Vol.22卷第No.12期. 2003 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101201627A (zh) | 2008-06-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN100557540C (zh) | 一种基于磁航向传感器的无人机航向自动修正方法 | |
| JP6161638B2 (ja) | 定常バンク角旋回を使用した風算出システム | |
| Cho et al. | Wind estimation and airspeed calibration using a UAV with a single-antenna GPS receiver and pitot tube | |
| CN102508493B (zh) | 一种小型无人飞行器飞行控制方法 | |
| US20090171518A1 (en) | Automatic Aircraft Takeoff and Landing Apparatus and Method for Accomplishing the Same | |
| Jann | Advanced features for autonomous parafoil guidance, navigation and control | |
| CN101445156A (zh) | 智能化空中机器人系统集成技术 | |
| CN104503466A (zh) | 一种微小型无人机导航装置 | |
| Skulstad et al. | Autonomous net recovery of fixed-wing UAV with single-frequency carrier-phase differential GNSS | |
| CN105843249A (zh) | 基于Pixhawk飞控的无人机自动巡航系统及其巡航方法 | |
| CN104635743A (zh) | 一种高速无人机超低空全程自主飞行控制系统 | |
| US6580389B2 (en) | Attitude determination using a global positioning system | |
| US11624611B1 (en) | Self-locating compass | |
| Wilson et al. | Vision‐aided Guidance and Navigation for Close Formation Flight | |
| Cho et al. | Fully automatic taxiing, takeoff and landing of a UAV using a single-antenna GPS receiver only | |
| US20050040985A1 (en) | System and method for providing improved accuracy relative positioning from a lower end GPS receiver | |
| US12106672B2 (en) | Aircraft sensor system synchronization | |
| Zeng et al. | A UAV localization system based on double UWB tags and IMU for landing platform | |
| Kong et al. | A ground-based multi-sensor system for autonomous landing of a fixed wing UAV | |
| Rosser et al. | Low complexity visual UAV track navigation using long‐wavelength infrared | |
| Rosser et al. | Reducing the complexity of visual navigation: Optical track controller for long‐range unmanned aerial vehicles | |
| CN108873031A (zh) | 一种2自由度吊舱的外参标定优化方法 | |
| US11675026B1 (en) | Self-locating compass | |
| Pei et al. | Methods for monitoring and controlling multi-rotor micro-UAVs position and orientation based on LabVIEW | |
| Hsiao et al. | The Design of a Small UAV System as a Testbed for Formation Flight |
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 | ||
| C17 | Cessation of patent right | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20091104 Termination date: 20111225 |