CN110440805A - 一种偏航角的融合方法、装置及飞行器 - Google Patents
一种偏航角的融合方法、装置及飞行器 Download PDFInfo
- Publication number
- CN110440805A CN110440805A CN201910734158.4A CN201910734158A CN110440805A CN 110440805 A CN110440805 A CN 110440805A CN 201910734158 A CN201910734158 A CN 201910734158A CN 110440805 A CN110440805 A CN 110440805A
- Authority
- CN
- China
- Prior art keywords
- yaw angle
- imu
- angular speed
- data
- gps
- 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
- 238000007500 overflow downdraw method Methods 0.000 title claims abstract description 32
- 230000004927 fusion Effects 0.000 claims abstract description 156
- 230000001133 acceleration Effects 0.000 claims abstract description 128
- 238000012937 correction Methods 0.000 claims abstract description 52
- 239000013598 vector Substances 0.000 claims description 55
- 238000010606 normalization Methods 0.000 claims description 31
- 238000000034 method Methods 0.000 claims description 30
- 238000012545 processing Methods 0.000 claims description 20
- 230000015654 memory Effects 0.000 claims description 16
- 230000015572 biosynthetic process Effects 0.000 claims description 8
- 230000003068 static effect Effects 0.000 claims description 8
- 201000009482 yaws Diseases 0.000 claims description 8
- 238000004891 communication Methods 0.000 claims description 3
- 230000000295 complement effect Effects 0.000 abstract description 21
- 238000005516 engineering process Methods 0.000 abstract description 4
- 239000011159 matrix material Substances 0.000 description 26
- 230000005611 electricity Effects 0.000 description 23
- 238000010586 diagram Methods 0.000 description 18
- 238000005259 measurement Methods 0.000 description 17
- 230000009466 transformation Effects 0.000 description 16
- 238000004422 calculation algorithm Methods 0.000 description 13
- 238000001914 filtration Methods 0.000 description 13
- 230000006870 function Effects 0.000 description 11
- 230000000875 corresponding effect Effects 0.000 description 9
- 230000008030 elimination Effects 0.000 description 6
- 238000003379 elimination reaction Methods 0.000 description 6
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 5
- 238000004590 computer program Methods 0.000 description 4
- 238000006073 displacement reaction Methods 0.000 description 4
- 238000005070 sampling Methods 0.000 description 4
- 230000000007 visual effect Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 3
- 230000001276 controlling effect Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000033228 biological regulation Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 230000002596 correlated effect Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 239000000203 mixture Substances 0.000 description 2
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000003139 buffering effect Effects 0.000 description 1
- 238000006880 cross-coupling reaction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- JEIPFZHSYJVQDO-UHFFFAOYSA-N ferric oxide Chemical compound O=[Fe]O[Fe]=O JEIPFZHSYJVQDO-UHFFFAOYSA-N 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 239000000155 melt Substances 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 238000010977 unit operation Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
-
- 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
- G01C21/1654—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 with electromagnetic compass
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENTS OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D27/00—Arrangement or mounting of power plant in aircraft; Aircraft characterised thereby
- B64D27/02—Aircraft characterised by the type or position of power plant
-
- 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
-
- 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/20—Instruments for performing navigational calculations
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C39/00—Aircraft not otherwise provided for
- B64C39/02—Aircraft not otherwise provided for characterised by special use
- B64C39/024—Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U10/00—Type of UAV
- B64U10/10—Rotorcrafts
- B64U10/13—Flying platforms
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U10/00—Type of UAV
- B64U10/10—Rotorcrafts
- B64U10/13—Flying platforms
- B64U10/14—Flying platforms with four distinct rotor axes, e.g. quadcopters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U30/00—Means for producing lift; Empennages; Arrangements thereof
- B64U30/20—Rotors; Rotor supports
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U50/00—Propulsion; Power supply
- B64U50/10—Propulsion
- B64U50/19—Propulsion using electrically powered motors
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Electromagnetism (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及飞行器技术领域，公开了一种偏航角的融合方法、装置及飞行器，所述方法包括：获取磁力计数据、IMU数据以及GPS数据；根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。通过上述方式，本发明解决一次互补滤波误差较大的技术问题，提高偏航角的融合精度以及稳定性。
Description
技术领域
本发明涉及飞行器技术领域，特别是涉及一种偏航角的融合方法、装置及飞行器。
背景技术
飞行器，如无人飞行器(Unmanned Aerial Vehicle，UAV)，也称无人机，以其具有体积小、重量轻、机动灵活、反应快速、无人驾驶、操作要求低等优点，得到了越来越广泛的应用。无人飞行器的各个动作(或姿态)通常是通过控制无人飞行器的动力装置中的多个驱动电机不同转速实现的。其中，偏航角是对无人飞行器的飞行姿态进行控制中的重要参数，也即无人飞行器的偏航角融合对无人飞行器的姿态控制尤其重要，若无人飞行器的偏航角融合误差大，或者融合精度低，轻则无人飞行器无法按照预设的方向或轨迹飞行，重则出现刷锅现象，甚至可能失稳以致炸机。
目前，飞行器的偏航角融合一般采用互补滤波方案，通过综合多个传感器信息，取长补短，采用权重调度及相互修正的方法来进行数据融合，但是，对于飞行器长时间的飞行或者长时间转偏航角飞行等情况，仅仅采用一次滤波存在较大的误差，很难保证偏航角的稳定性和融合精度。
发明内容
本发明实施例提供一种偏航角的融合方法、装置及飞行器，解决一次互补滤波误差较大的技术问题，提高偏航角的融合精度以及稳定性。
为解决上述技术问题，本发明实施例提供以下技术方案：
第一方面，本发明实施例提供一种偏航角的融合方法，应用于飞行器，所述方法包括：
获取磁力计数据、IMU数据以及GPS数据，其中，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；
根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；
根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；
根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；
根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；
根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。
在一些实施例中，所述根据所述GPS数据以及所述磁力计数据，确定所述偏航角角速度修正量，包括：
根据所述GPS数据，获取所述飞行器当前位置的磁场向量；
根据所述磁力计数据，确定磁力计的磁场向量；
根据所述飞行器当前位置的磁场向量以及所述磁力计的磁场向量，计算磁北极误差角；
根据所述磁北极误差角，确定所述偏航角角速度修正量。
在一些实施例中，所述根据所述IMU加速度信息以及所述GPS加速度信息，确定所述第一偏航角角速度误差值，包括：
对所述IMU数据进行坐标变换，以生成地面坐标系下的IMU加速度信息；
对所述GPS数据进行信号处理，以生成水平加速度信息；
对所述地面坐标系下的IMU加速度信息以及所述水平加速度信息求矢量夹角，将所述矢量夹角作为所述第一偏航角角速度误差值。
在一些实施例中，在对所述IMU数据进行坐标变换，以生成地面坐标系下的所述IMU加速度信息之前,该方法还包括:
根据所述IMU数据，生成静止标志位，其中，所述静止标志位用于反映所述飞行器是否处于静止状态；
根据所述IMU数据和所述静止标志位，获得IMU数据的偏移数据；
获取所述IMU数据和所述IMU数据的偏移数据的差值；则，
所述对所述IMU数据进行坐标变换，以生成地面坐标系下的所述IMU加速度信息，包括：
对所述IMU数据和所述IMU数据的偏移数据的差值进行坐标变换，以生成地面坐标系下的所述IMU加速度信息。
在一些实施例中，所述根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定所述初始互补融合偏航角角速度，包括：
对所述地面坐标系下的IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值进行求和，将求和结果作为所述初始互补融合偏航角角速度。
在一些实施例中，所述根据所述IMU加速度信息以及所述GPS速度信息，确定所述第二偏航角角速度误差值，包括：
对所述IMU加速度信息进行积分，以生成积分IMU速度信息；
对所述积分IMU速度信息进行归一化处理，生成归一化IMU速度信息；
对所述GPS速度信息进行归一化处理，生成归一化GPS速度信息；
根据所述归一化IMU速度信息以及所述归一化GPS速度信息，生成速度差值；
对所述速度差值进行微分，生成所述第二偏航角角速度误差值。
在本发明实施例中，所述根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定所述最终互补融合偏航角，包括：
计算所述初始互补融合偏航角角速度与上一时刻的最终互补融合偏航角的差值，以确定第一角速度差值；
计算所述第二偏航角角速度误差值与上一时刻的最终互补融合偏航角的差值，以确定第二角速度差值；
根据所述第一角速度差值以及所述第二角速度差值，确定第一权重和第二权重；
对所述第一权重和所述第二权重进行归一化处理，以生成第一权重比例系数以及第二权重比例系数；
对所述初始互补融合偏航角角速度以及所述第一权重比例系数进行求积，以生成第一乘积值；
对所述第二偏航角角速度误差值以及所述第二权重比例系数进行求积，生成第二乘积值；
根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角。
在一些实施例中，所述根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角，包括：
对所述第一权重和所述第二权重进行求和，以生成权重和；
对所述第一乘积值和所述第二乘积值进行求和，以生成乘积和；
根据所述权重和以及所述乘积和，确定所述最终互补融合偏航角。
第二方面，本发明实施例提供一种偏航角的融合装置，应用于飞行器，所述装置包括：
获取模块，用于获取磁力计数据、IMU数据以及GPS数据，其中，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；
偏航角角速度修正量模块，用于根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；
第一偏航角角速度误差值模块，用于根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；
初始互补融合偏航角角速度模块，用于根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；
第二偏航角角速度误差值模块，用于根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；
最终互补融合偏航角模块，用于根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。
在一些实施例中，所述偏航角角速度修正量模块，具体用于：
根据所述GPS数据，获取所述飞行器当前位置的磁场向量；
根据所述磁力计数据，确定磁力计的磁场向量；
根据所述飞行器当前位置的磁场向量以及所述磁力计的磁场向量，计算磁北极误差角；
根据所述磁北极误差角，确定所述偏航角角速度修正量。
在一些实施例中，所述第一偏航角角速度误差值模块，具体用于：
对所述IMU数据进行坐标变换，以生成地面坐标系下的IMU加速度信息；
对所述GPS数据进行信号处理，以生成水平加速度信息；
对所述地面坐标系下的IMU加速度信息以及所述水平加速度信息求矢量夹角，将所述矢量夹角作为所述第一偏航角角速度误差值。
在一些实施例中，所述装置还包括：
静止标志位模块，用于根据所述IMU数据，生成静止标志位，其中，所述静止标志位用于反映所述飞行器是否处于静止状态；
IMU偏移数据差值模块，用于根据所述IMU数据和所述静止标志位，获得IMU数据的偏移数据；获取所述IMU数据和所述IMU数据的偏移数据的差值；
所述第一偏航角角速度误差值模块，具体用于：
对所述IMU数据和所述IMU数据的偏移数据的差值进行坐标变换，以生成地面坐标系下的所述IMU加速度信息。
在一些实施例中，所述初始互补融合偏航角角速度模块，具体用于：
对所述地面坐标系下的IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值进行求和，将求和结果作为所述初始互补融合偏航角角速度。
在一些实施例中，所述第二偏航角角速度误差值模块，具体用于：
对所述IMU加速度信息进行积分，以生成积分IMU速度信息；
对所述积分IMU速度信息进行归一化处理，生成归一化IMU速度信息；
对所述GPS速度信息进行归一化处理，生成归一化GPS速度信息；
根据所述归一化IMU速度信息以及所述归一化GPS速度信息，生成速度差值；
对所述速度差值进行微分，生成所述第二偏航角角速度误差值。
在一些实施例中，所述最终互补融合偏航角模块，包括：
第一角速度差值单元，用于计算所述初始互补融合偏航角角速度与所述上一时刻的最终互补融合偏航角的差值，以确定第一角速度差值；
第二角速度差值单元，用于计算所述第二偏航角角速度误差值与上一时刻的最终互补融合偏航角的差值，确定第二角速度差值；
权重单元，用于根据所述第一角速度差值以及所述第二角速度差值，确定第一权重和第二权重；
权重比例系数单元，用于对所述第一权重和所述第二权重进行归一化处理，生成第一权重比例系数以及第二权重比例系数；
第一乘积值单元，用于对所述初始互补融合偏航角角速度以及所述第一权重比例系数进行求积，以生成第一乘积值；
第二乘积值单元，用于对所述第二偏航角角速度误差值以及所述第二权重比例系数进行求积，以生成第二乘积值；
最终互补融合偏航角单元，用于根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角。
在一些实施例中，所述最终互补融合偏航角单元，具体用于：
对所述第一权重和所述第二权重进行求和，以生成权重和；
对所述第一乘积值和所述第二乘积值进行求和，以生成乘积和；
根据所述权重和以及所述乘积和，确定所述最终互补融合偏航角。
第三方面，本发明实施例提供一种飞行器，包括：
机身；
机臂，与所述机身相连；
动力装置，设于所述机臂，用于给所述飞行器提供飞行的动力；以及
飞行控制器，设于所述机身；
其中，所述飞行控制器包括：
至少一个处理器；以及，
与所述至少一个处理器通信连接的存储器；其中，
所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被所述至少一个处理器执行，以使所述至少一个处理器能够执行如上所述的偏航角的融合方法。
第四方面，本发明实施例还提供了一种非易失性计算机可读存储介质，所述计算机可读存储介质存储有计算机可执行指令，所述计算机可执行指令用于使飞行器能够执行如上所述的偏航角的融合方法。
本发明实施例的有益效果是：区别于现有技术的情况下，本发明实施例提供的一种偏航角的融合方法，应用于飞行器，所述方法包括：获取磁力计数据、IMU数据以及GPS数据，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。通过上述方式，本发明解决一次互补滤波误差较大的技术问题，提高偏航角的融合精度以及稳定性。
附图说明
一个或多个实施例通过与之对应的附图中的图片进行示例性说明，这些示例性说明并不构成对实施例的限定，附图中具有相同参考数字标号的元件表示为类似的元件，除非有特别申明，附图中的图不构成比例限制。
图1是本发明实施例提供的一种飞行器的具体结构图；
图2是本发明实施例提供的一种偏航角的融合方法的原理框图；
图3是图2中的一种二次互补滤波算法的原理框图；
图4是图2中的另一种二次互补滤波算法的原理框图；
图5是本发明实施例提供的一种偏航角的融合方法的流程示意图；
图6是图5中的步骤S20的细化流程图；
图7是图5中的步骤S30的细化流程图；
图8是图5中的步骤S50的细化流程图；
图9是图5中的步骤S60的细化流程图；
图10是图9中的步骤S67的细化流程图；
图11是本发明实施例提供的一种偏航角的融合装置的示意图；
图12是图11中的最终互补融合偏航角模块的示意图；
图13是本发明实施例提供的一种飞行器的硬件结构示意图；
图14是本发明实施例提供的一种飞行器的连接框图；
图15是图14中的动力装置的示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明实施例提供的偏航角的融合方法可以应用到各种通过电机或马达驱动的可移动物体上，包括但不限于飞行器、机器人等。其中飞行器可包括无人飞行器(unmannedaerial vehicle，UAV)，无人飞船等。
其中，本发明实施例的偏航角的融合方法，应用于飞行器的飞行控制器。
请参阅图1，图1是本发明实施例提供的一种飞行器的具体结构图；
如图1所示，该飞行器10包括：机身11、与所述机身11相连的机臂12、设置于所述机臂12的动力装置13，连接至该机身11底部的云台14，安装在云台14上的摄像头15以及设置于机身11内的飞行控制器(图未示)。
其中，飞行控制器与动力装置13连接，动力装置13安装在所述机身11上，用于为所述飞行器10提供飞行动力。具体的，飞行控制器用于执行上述的偏航角的融合方法以修正飞行器的偏航角，并根据融合后的飞行器的偏航角生成控制指令，并将该控制指令发送给动力装置13的电调，电调通过该控制指令控制动力装置13的驱动电机。或者，飞行控制器用于执行偏航角的融合方法以修正飞行器的偏航角，并将修正后的飞行器的偏航角发送至电调，电调根据修正后的飞行器的偏航角生成控制指令，并通过该控制指令控制动力装置13的驱动电机。
机身11包括：中心壳体以及与中心壳体连接的一个或多个机臂，一个或多个机臂呈辐射状从中心壳体延伸出。机臂与中心壳体的连接可以是一体连接或者固定连接。动力装置安装于机臂上。
飞行控制器用于执行上述偏航角的融合方法以修正飞行器的偏航角，并根据修正后的飞行器的偏航角生成控制指令，并将该控制指令发送给动力装置的电调，以便电调通过该控制指令控制动力装置的驱动电机。控制器为具有一定逻辑处理能力的器件，如控制芯片、单片机、微控制单元(Microcontroller Unit，MCU)等。
动力装置13包括：电调，驱动电机和螺旋桨。电调位于机臂或中心壳体所形成的空腔内。电调分别与控制器及驱动电机连接。具体的，电调与驱动电机电连接，用于控制所述驱动电机。驱动电机安装在机臂上，驱动电机的转动轴连接螺旋桨。螺旋桨在驱动电机的驱动下产生使得飞行器10移动的力，例如，使得飞行器10移动的升力或者推力。
飞行器10完成各个规定速度、动作(或姿态)是通过电调控制驱动电机以实现的。电调全称电子调速器，根据控制信号调节飞行器10的驱动电机的转速。其中，控制器为执行上述偏航角的融合方法的执行主体，电调基于融合后的飞行器的偏航角所生成控制指令来控制驱动电机。电调控制驱动电机的原理大致为：驱动电机是将电脉冲信号转变为角位移或线位移的开环控制元件。在非超载的情况下，驱动电机的转速、停止的位置只取决于脉冲信号的频率和脉冲数，而不受负载变化的影响，当驱动器接收到一个脉冲信号，它就驱动动力装置的驱动电机按设定的方向转动一个固定的角度，它的旋转是以固定的角度运行的。因此，电调可以通过控制脉冲个数来控制角位移量，从而达到准确定位的目的；同时可以通过控制脉冲频率来控制驱动电机转动的速度和加速度，从而达到调速的目的。
目前飞行器10主要功能为航拍、影像实时传输、高危地区探测等。为了实现航拍、影像实时传输、高危地区探测等功能，飞行器10上会连接有摄像组件。具体的，飞行器10和摄像组件通过连接结构，如减振球等进行连接。该摄像组件用于在飞行器10进行航拍的过程中，获取拍摄画面。
具体的，摄像组件包括：云台及拍摄装置。云台与飞行器10连接。其中，拍摄装置搭载于所述云台上，拍摄装置可以为图像采集装置，用于采集图像，该拍摄装置包括但不限于：相机、摄影机、摄像头、扫描仪、拍照手机等。云台用于搭载拍摄装置，以实现拍摄装置的固定、或随意调节拍摄装置的姿态(例如，改变拍摄装置的高度、倾角和/或方向)以及使所述拍摄装置稳定保持在设定的姿态上。例如，当飞行器10进行航拍时，云台主要用于使所述拍摄装置稳定保持在设定的姿态上，防止拍摄装置拍摄画面抖动，保证拍摄画面的稳定。
云台14与飞行控制器连接，以实现云台14与飞行控制器之间的数据交互。例如，飞行控制器发送偏航指令至云台14，云台14获取偏航的速度和方向指令并执行，且将执行偏航指令后所产生的数据信息发送至飞行控制器，以便飞行控制器检测当前偏航状况。
云台包括：云台电机及云台基座。其中，云台电机安装于云台基座。飞行控制器也可通过动力装置13的电调来控制云台电机，具体的，飞行控制器与电调连接，电调与云台电机电连接，飞行控制器生成云台电机控制指令，电调通过云台电机控制指令以控制云台电机。
云台基座与飞行器的机身连接，用于将摄像组件固定安装于飞行器的机身上。
云台电机分别与云台基座及拍摄装置连接。该云台可以为多轴云台，与之适应的，云台电机为多个，也即每个轴设置有一个云台电机。云台电机一方面可带动拍摄装置的转动，从而满足拍摄转轴的水平旋转和俯仰角度的调节，通过手动远程控制云台电机旋转或利用程序让电机自动旋转，从而达到全方位扫描监控的作用；另一方面，在飞行器进行航拍的过程中，通过云台电机的转动实时抵消拍摄装置受到的扰动，防止拍摄装置抖动，保证拍摄画面的稳定。
拍摄装置搭载于云台上，拍摄装置上设置有惯性测量单元(Inertialmeasurement unit，IMU)，该惯性测量单元用于测量物体三轴姿态角(或角速率)以及加速度的装置。一般的，一个IMU内会装有三轴的陀螺仪和三个方向的加速度计，来测量物体在三维空间中的角速度和加速度，并以此解算出物体的姿态。为了提高可靠性，还可以为每个轴配备更多的传感器。一般而言IMU要安装在飞行器的重心上。
在对飞行器的姿态进行控制的过程中，飞行器的偏航角是对飞行器的姿态进行控制中的重要参数，需要基于飞行器的偏航角，来控制驱动电机。通过飞行器的控制器实时获取飞行器的偏航角，为飞行器的姿态控制提供必要的姿态信息。也即飞行器的偏航角正确估算对飞行器的姿态控制尤其重要，若飞行器的偏航角估算错误，飞行器轻则无法按照预设的方向或轨迹飞行，重则可能失稳以致炸机。
在室内环境中，由于没有GPS信息修正，磁力计也受到严重干扰，因此导致存在缺乏足够的可用信息来进行偏航角的修正的问题，而且，由于陀螺仪积分本身存在漂移特性，因此在室内飞行或悬停时，飞行器容易发生偏航角偏移。
目前，飞行器在室内的飞行主要靠视觉信息修正或磁力计修正来修正偏航角，而视觉信息修正对于无视觉的飞机来说不可取，并且，由于视觉运算量大，对于视觉单元运算力较弱的飞机，会影响其他视觉信息的解算，而若要不影响，则需要更换更好的视觉模块，增加成本，而采用磁力计修正的方法容易受到在干扰时，飞行器偏航角偏差严重或漂移。
因此，基于上述问题，本发明实施例主要目的在于提供一种偏航角的融合方法、装置及飞行器，可以通过二次互补融合对飞行器的偏航角进行修正，解决对于飞行器长时间的飞行或者长时间转偏航角飞行等情况，仅仅采用一次滤波存在较大的误差的问题，从而提高偏航角的融合精度以及稳定性。
本发明实施例通过获取GPS数据、IMU数据以及磁力计数据，尽可能多的利用多个传感器的数据进行修正，通过一次互补滤波之后，再进行二次互补滤波进行补偿，能够保证滤波的稳定性。
下面结合附图，对本发明实施例作进一步阐述。
实施例一
请参阅图2，图2是本发明实施例提供的一种偏航角的融合方法的原理框图；
如图2所示，通过获取GPS数据、磁力计数据以及IMU数据，并根据所述GPS数据，进行经纬度信息查表，对所述磁力计数据进行信号处理，从而求磁北极误差角，将所述磁北极误差角通过反馈控制器反馈的方式生成偏航角角速度修正量，以及，通过IMU数据，获取IMU角速度，通过GPS数据以及IMU数据，获取偏航角角速度补偿量，对所述偏航角角速度修正量、IMU角速度以及偏航角角速度补偿量进行融合，生成初始互补融合偏航角，并且，通过对IMU加速度进行积分，并对积分后的速度进行归一化，对GPS速度进行归一化，对归一化后的速度求矢量夹角，对所述矢量夹角进行微分，生成第二偏航角角速度误差值，通过对所述初始互补融合偏航角以及所述第二偏航角角速度误差值进行二次互补滤波，得到最终偏航角角速度，对所述最终偏航角角速度进行积分，获取最终互补融合偏航角。
请再参阅图3，图3是图2中的一种二次互补滤波算法的原理框图；
如图3所示，通过对初始互补融合偏航角角速度进行滤波以及去野值处理，并且，对第二偏航角角速度误差值进行去野值处理，通过对处理后的初始互补融合偏航角角速度与最终偏航角角速度进行矢量夹角求解，获取第一角速度差值，通过对第二偏航角角速度误差值与最终偏航角角速度进行矢量夹角求解，获取第二角速度差值，通过所述第一角速度差值以及第二角速度差值进行求权重，分别生成第一权重和第二权重，并对所述第一权重和第二权重进行权重归一化处理，根据所述权重归一化处理后的第一权重和第二权重，分别将其与其对应的初始互补融合偏航角角速度或第二偏航角角速度误差值进行求积处理，分别生成第一乘积值以及第二乘积值，对所述第一乘积值和第二乘积值进行融合，生成最终偏航角角速度。
请再参阅图4，图4是图2中的另一种二次互补滤波算法的原理框图；
其中，图4中的二次互补滤波算法与图3中的二次互补滤波算法大部分相似，在此不再进行赘述，与之不同的是，图4中的二次互补滤波算法，通过对第一权重和第二权重进行求和，生成权重和，通过乘积和与权重和进行相除，将相除的结果作为最终偏航角角速度。
请参阅图5，图5是本发明实施例提供的一种偏航角的融合方法的流程示意图；
其中，该偏航角的融合方法可由各种具有一定逻辑处理能力的电子设备执行，如飞行器、控制芯片等，该飞行器可以包括无人机、无人船等。以下电子设备以飞行器为例进行说明。其中，飞行器连接有云台，云台包括云台电机及云台基座，其中，云台可以为多轴云台，如两轴云台、三轴云台，以下三轴云台为例进行说明。对于该飞行器及云台的具体结构的描述可以参考上述描述，因此，在此处不作赘述。
如图5所示，所述方法应用于飞行器，比如，无人机，所述方法包括：
步骤S10：获取磁力计数据、IMU数据以及GPS数据，其中，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；
具体的，所述飞行器设置有姿态传感器组件，所述姿态传感器组件包括：惯性测量单元(Inertial measurement unit，IMU)、磁力计等，其中，所述惯性测量单元IMU用于获取IMU数据，所述磁力计用于获取磁力计数据，所述惯性测量单元包括陀螺仪以及加速度计，所述陀螺仪用于获取IMU角速度，所述加速度计用于获取IMU角速度信息，所述IMU数据包括：IMU加速度信息以及IMU角速度信息，所述磁力计数据包括：磁场强度信息。所述飞行器还设置有GPS模块，所述GPS模块用于获取GPS数据，所述GPS数据包括GPS速度信息以及GPS加速度信息。
具体的，通过惯性测量单元获取IMU数据，所述惯性测量单元获取的IMU数据为原始IMU数据，需要对所述原始IMU数据进行处理，例如：对所述IMU数据进行校准、坐标系转换，生成IMU加速度信息以及IMU角速度信息，其中，所述IMU加速度信息为惯性测量单元的测量数据经过校准矩阵进行校准以及机体坐标系到地面坐标系的坐标变换之后，所得到的地面坐标系下的加速度信息。可以理解的是，所述校准矩阵是用户在要飞行的地方校准得到的，校准矩阵在地球上任意地方都不同，飞行器在报磁力计干扰，要求用户校准之后才能确定所述校准矩阵。
其中，所述机体坐标系到地面坐标系的转换通过旋转变换矩阵完成，具体的，根据所述飞行器的姿态角，生成旋转变换矩阵，通过所述旋转变换矩阵，将所述IMU数据从机体坐标系转换到地面坐标系，生成所述IMU加速度信息以及所述IMU角速度信息。具体的，所述飞行器的姿态角包括：偏航角、俯仰角以及翻滚角，其中，所述偏航角为当前的融合偏航角，即实时的融合偏航角会用于计算旋转变换矩阵，进而用于下一次的融合，不断更新所述融合偏航角。例如：所述旋转变换矩阵为3*3的矩阵，其中包含了所述偏航角、俯仰角、翻滚角的正弦余弦函数，并根据具体情况选择不同的函数，一般而言，通过先转动偏航角，再转动俯仰角，最后转动翻滚角，例如：所述旋转变换矩阵为：
其中，(φ,θ,ψ)为所述姿态角，φ为所述姿态角中的翻滚角，θ为所述姿态角中的俯仰角，ψ为所述姿态角中的偏航角。
步骤S20：根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；
其中，所述磁力计数据通过磁力计获取，所述磁力计数据包括：磁场强度信息，所述磁场强度为三轴磁场强度，由于磁力计测量的磁力计数据是机体坐标系下的三轴磁场强度，因此需要通过校准矩阵去除bias和交叉耦合，并且，通过旋转矩阵将其变换至地面坐标系下。具体的，请再参阅图6，图6是图5中的步骤S20的细化流程图；
如图6所示，所述根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量，包括：
步骤S21：根据所述GPS数据，获取所述飞行器当前位置的磁场向量；
具体的，飞行器在室外开机后，飞行器的GPS模块会接收到GPS数据，所述GPS数据包括经纬度信息以及速度信息，通过对所述经纬度信息进行插值计算，从而确定所述飞行器的当前位置的标准磁场强度、磁偏角以及磁倾角，即获取所述飞行器当前位置的磁场向量。
步骤S22：根据所述磁力计数据，确定磁力计的磁场向量；
具体的，所述飞行器设置有磁力计，所述磁力计可以为三轴磁力计，所述磁力计三轴读数组成一个向量，从而确定磁力计的磁场向量。
可以理解的是，由于磁力计数据存在干扰，需要对其进行校准。具体的，根据预设的校准矩阵对所述磁力计数据进行校准，生成校准后的磁力计数据，其中，所述预设的校准矩阵是用户在要飞行的地方校准得到的，校准矩阵在地球上任意地方都不同，飞行器在报磁力计干扰，要求用户校准之后才能确定所述校准矩阵。
步骤S23：根据所述飞行器当前位置的磁场向量以及所述磁力计的磁场向量，计算磁北极误差角；
其中，当地标准磁场强度、磁偏角以及磁倾角用来配合磁力计数据进行航向计算，将计算得到的航向与飞机实际航向进行对比，通过旋转矩阵进行变换，可以得到在飞行器当前融合的姿态信息下，飞行器的磁力计的磁北极误差。具体的，通过现有的姿态角旋转矩阵的转置矩阵乘以磁力计的磁场向量，得到变换后的磁场向量，所述飞行器的当前位置的标准的地球磁场向量，将所述变换后的磁场向量与所述飞行器的当前位置的标准的地球磁场向量进行矢量夹角求解，将求得的矢量夹角作为所述磁北极误差角。
步骤S24：根据所述磁北极误差角，确定所述偏航角角速度修正量。
具体的，所述飞行器设置有反馈控制器，将所述磁北极误差角输入所述反馈控制器，所述反馈控制器通过反馈控制算法对所述磁北极误差角进行计算，生成所述偏航角角速度修正量，例如：所述偏航角角速度修正量与所述磁北极误差角负相关，比如：通过如下公式计算所述偏航角角速度修正量，Correct＝-K*error；其中，Correct为偏航角角速度修正量，K为增益，K值需要工程师根据情况设计。
步骤S30：根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；
其中，所述IMU加速度为对惯性测量单元IMU测量得到的原始IMU数据进行相应的处理得到的加速度信息，例如：对所述原始IMU数据进行坐标系变换、bias估计等。具体的，请参阅图7，图7是图5中的步骤S30的细化流程图；
如图7所示，所述根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值，包括：
步骤S31：对所述IMU数据进行坐标变换，以生成地面坐标系下的IMU加速度信息；
具体的，所述IMU数据为惯性测量单元IMU测量得到的原始IMU数据，需要对其进行坐标系变换，将机体坐标系变换到地面坐标系，其中，所述机体坐标系到地面坐标系的转换通过旋转变换矩阵完成，具体的，根据所述飞行器的姿态角，生成旋转变换矩阵，通过所述旋转变换矩阵，将所述IMU数据从机体坐标系转换到地面坐标系，生成所述IMU加速度信息以及所述IMU角速度信息。具体的，所述飞行器的姿态角包括：偏航角、俯仰角以及翻滚角，其中，所述偏航角为当前的融合偏航角，即实时的融合偏航角会用于计算旋转变换矩阵，进而用于下一次的融合，不断更新所述融合偏航角。例如：所述旋转变换矩阵为3*3的矩阵，其中包含了所述偏航角、俯仰角、翻滚角的正弦余弦函数，并根据具体情况选择不同的函数，一般而言，通过先转动偏航角，再转动俯仰角，最后转动翻滚角，例如：所述旋转变换矩阵为：
其中，(φ,θ,ψ)为所述姿态角，φ为所述姿态角中的翻滚角，θ为所述姿态角中的俯仰角，ψ为所述姿态角中的偏航角。
在本发明实施例中，在对所述IMU数据进行坐标变换，以生成地面坐标系下的所述IMU加速度信息之前,该方法还包括:
根据所述IMU数据，生成静止标志位，其中，所述静止标志位用于反映所述飞行器是否处于静止状态；
根据所述IMU数据和所述静止标志位，获得IMU数据的偏移数据；
获取所述IMU数据和所述IMU数据的偏移数据的差值；则，
所述对所述IMU数据进行坐标变换，以生成地面坐标系下的所述IMU加速度信息，包括：
对所述IMU数据和所述IMU数据的偏移数据的差值进行坐标变换，以生成地面坐标系下的所述IMU加速度信息。
具体的，在对所述IMU数据进行坐标系变换之前，对所述IMU数据进行bias估计。由于IMU数据有偏移特性，因此需要将其bias考虑进去。通过惯性测量单元IMU采集的加速度和角速度信息，判断飞机是否处于静止状态下，生成一个静止标志位，再将IMU数据和静止标志位打包，进行bias估计，获得IMU数据的偏移数据，即得到加速度bias信息和角速度bias信息，其中，所述加速度bias信息和角速度bias信息均为对应的零偏值，获取所述IMU数据和所述IMU数据的偏移数据的差值，亦即，将IMU数据中的加速度信息与所述加速度bias信息进行作差，生成预估的加速度信息，同理，将IMU数据中的角速度信息与所述角速度bias信息进行作差，生成预估的角速度信息，通过bias估计去除零偏的影响，有利于修正偏航角。
其中，所述对所述IMU数据和所述IMU数据的偏移数据的差值进行坐标变换，以生成地面坐标系下的所述IMU加速度信息，包括：通过将所述预估的加速度信息与所述预估的角速度信息进行坐标系变换，生成地面坐标系下的加速度信息和角速度信息。可以理解的是，所述地面坐标系下的加速度信息和角速度信息仍然不够准确，需要进一步的修正。
步骤S32：对所述GPS数据进行信号处理，以生成水平加速度信息；
具体的，所述GPS数据用于计算GPS加速度和GPS速度，由于GPS数据计算出的GPS加速度存在噪声，因此需要进行信号处理，例如：滤波处理，其中，滤波算法多种多样，卡尔曼滤波、均值滤波、频域低通滤波等等。将所述GPS数据进行滤波处理后，数据噪声消除，能够提高准确度，通过对所述GPS数据进行信号处理，生成水平加速度信息以及水平速度信息。
步骤S33：对所述地面坐标系下的IMU加速度信息以及所述水平加速度信息求矢量夹角，将所述矢量夹角作为所述第一偏航角角速度误差值。
具体的，由于IMU加速度信息和水平加速度信息来自于不同的传感器，因此可以将所述IMU加速度信息和所述水平加速度信息用于进行偏航角修正。通过对所述地面坐标系下的IMU加速度信息以及所述水平加速度信息进行矢量夹角求解，从而计算地面坐标系下的IMU加速度信息以及所述水平加速度信息的角度差，将所述矢量夹角作为所述第一偏航角角速度误差值。
步骤S40：根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；
具体的，所述根据所述IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度，包括：
对所述地面坐标系下的IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值进行求和，将求和结果作为所述初始互补融合偏航角角速度，其中，所述初始互补融合偏航角为一次互补修正后的偏航角角速度信息。
具体的，所述方法还包括：将所述第一偏航角角速度误差值输入反馈控制器，所述反馈控制器通过反馈控制算法，对所述第一偏航角角速度误差值进行计算，生成偏航角角速度补偿量，例如：所述偏航角角速度补偿量与所述第一偏航角角速度误差值负相关，比如：通过如下公式计算所述偏航角角速度补偿量，Correct＝-K*error；其中，Correct为偏航角角速度补偿量，K为增益，K值需要工程师根据情况设计。
通过对所述IMU角速度信息、偏航角角速度修正量以及所述偏航角角速度补偿量进行融合，生成初始互补融合偏航角，其中，所述初始互补融合偏航角为一次互补修正后的偏航角角速度信息。
步骤S50：根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；
具体的，请参阅图8，图8是图5中的步骤S50的细化流程图；
如图8所示，所述根据所述IMU加速度信息以及所述GPS速度信息，确定所述第二偏航角角速度误差值，包括：
步骤S51：对所述IMU加速度信息进行积分，以生成积分IMU速度信息；
具体的，对地面坐标系下的IMU加速度信息进行积分，生成积分IMU速度信息。
步骤S52：对所述积分IMU速度信息进行归一化处理，生成归一化IMU速度信息；
由于积分运算获取的积分IMU速度信息可能存在漂移，因此需要对所述积分IMU速度信息进行归一化处理，生成归一化IMU速度信息。
步骤S53：对所述GPS速度信息进行归一化处理，生成归一化GPS速度信息；
由于所述GPS速度信息可能存在漂移，因此需要对所述GPS速度信息进行归一化处理，生成归一化IMU速度信息。
步骤S54：根据所述归一化IMU速度信息以及所述归一化GPS速度信息，生成速度差值；
具体的，通过对所述归一化IMU速度信息以及所述归一化GPS速度信息进行向量化处理，分别得到所述归一化IMU速度信息对应的水平面的单位向量以及所述归一化GPS速度信息对应的水平面的单位向量，通过对所述两个单位向量进行求矢量夹角运算，生成速度差值。
步骤S55：对所述速度差值进行微分，生成所述第二偏航角角速度误差值。
具体的，由于惯性测量单元IMU的加速度计存在bias，因此求得的速度差值准确性不高，但是通过微分处理之后，能够消除bias的影响，因此通过对所述速度差值进行微分来进行修正，生成第二偏航角角速度误差值。可以理解的是，在对所述速度差值进行微分处理之后，所述方法还包括：对所述微分后的速度差值进行滤波处理，其中，滤波算法多种多样，卡尔曼滤波、均值滤波、频域低通滤波等等。对所述速度差值进行微分处理以及滤波处理后，生成第二偏航角角速度误差值。
步骤S60：根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。
由于初始互补融合偏航角角速度以及所述第二偏航角角速度误差值均为飞行器偏航角角速度信息，均含有一定的不准确性，为了进一步提高融合的准确性，因此对所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值进行二次互补滤波，生成准确的偏航角角速度信息。
具体的，请参阅图9，图9是图5中的步骤S60的细化流程图；
如图9所示，所述根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角，包括：
步骤S61：计算所述初始互补融合偏航角角速度与上一时刻的最终互补融合偏航角的差值，确定第一角速度差值；
具体的，所述上一时刻的最终互补融合偏航角为上一次融合完成的最终互补融合偏航角，由于飞行器的每个采样步长均会做误差计算，通过反馈回路一直不停地进行，即偏航角也在不停地更新，因此每一采样时刻均对应唯一的最终互补融合偏航角。通过计算所述初始互补融合偏航角角速度与上一时刻的最终互补融合偏航角的差值，将所述差值作为第一角速度差值，有利于进行误差修正。
在本发明实施例中，在计算所述初始互补融合偏航角角速度与上一时刻的最终互补融合偏航角的差值，确定第一角速度差值步骤之前，所述方法还包括：
对所述初始互补融合偏航角角速度进行去野值处理和滤波处理，可以理解的是，在初始互补融合偏航角角速度信号中，存在偏离太远的值，称为野值，将所述野值置零，相当于进行了去野值处理，所述滤波处理通过滤波算法进行，其中，滤波算法多种多样，卡尔曼滤波、均值滤波、频域低通滤波等等。
步骤S62：计算所述第二偏航角角速度误差值与上一时刻的最终互补融合偏航角的差值，确定第二角速度差值；
具体的，所述上一时刻的最终互补融合偏航角为上一次融合完成的最终互补融合偏航角，由于飞行器的每个采样步长均会做误差计算，通过反馈回路一直不停地进行，即偏航角也在不停地更新，因此每一采样时刻均对应唯一的最终互补融合偏航角。通过计算所述第二偏航角角速度误差值与上一时刻的最终互补融合偏航角的差值，将所述差值确定为第二角速度差值，有利于进行误差修正。
在本发明实施例中，在计算所述第二偏航角角速度误差值与上一时刻的最终互补融合偏航角的差值，确定第二角速度差值步骤之前，所述方法还包括：
对所述第二偏航角角速度误差值进行去野值处理。根据去野值处理之后的结果与上一时刻的最终互补融合偏航角的差值，确定第二角速度差值。
步骤S63：根据所述第一角速度差值以及第二角速度差值，确定第一权重和第二权重；
具体的，所述根据所述第一角速度差值以及第二角速度差值，确定第一权重和第二权重，包括：对所述第一角速度差值以及所述第二角速度差值求和，得到求和结果，分别计算所述第一角速度差值和第二角速度差值与所述求和结果的比值，将所述第一角速度差值与所述求和结果的比值作为第一权重，将所述第二角速度差值与所述求和结果的比值作为第二权重。
步骤S64：对所述第一权重和第二权重进行归一化处理，生成第一权重比例系数以及第二权重比例系数；
具体的，对所述第一权重和第二权重分别进行归一化处理，生成第一权重比例系数以及第二权重比例系数，所述第一权重比例系数和第二权重比例系数用于消除初始互补融合偏航角角速度和第二偏航角角速度误差值的融合值的大小差异影响，通过权重比例系数的方式加权平均，能够使结果更为准确。
步骤S65：对所述初始互补融合偏航角角速度以及所述第一权重比例系数进行求积，生成第一乘积值；
步骤S66：对所述第二偏航角角速度误差值以及所述第二权重比例系数进行求积，生成第二乘积值；
步骤S67：根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角。
具体的，对所述第一乘积值和第二乘积值进行求和，将求和的结果作为所述最终互补融合偏航角。
请再参阅图10，图10是图9中的步骤S67的细化流程图；
如图10所示，所述根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角，包括：
步骤S671：对所述第一权重和第二权重进行求和，生成权重和；
步骤S672：对所述第一乘积值和第二乘积值进行求和，生成乘积和；
步骤S673：根据所述权重和以及所述乘积和，确定所述最终互补融合偏航角。
具体的，将所述乘积和除以所述权重和，将相除的结果作为所述最终互补融合偏航角。通过乘积和除以权重和的方式，能够进一步提高融合的准确性。
在本发明实施例中，通过提供一种偏航角的融合方法，应用于飞行器，所述方法包括：获取磁力计数据、IMU数据、GPS数据，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；根据所述IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。通过上述方式，本发明实施例能够解决一次互补滤波误差较大的技术问题，提高偏航角的融合精度以及稳定性。
实施例二
请参阅图11，图11是本发明实施例提供的一种偏航角的融合装置的示意图；
如图11所示，该偏航角的融合装置110，应用于飞行器，具体的，所述偏航角的融合装置110可以为飞行器的飞行控制器，所述装置包括：
获取模块111，用于获取磁力计数据、IMU数据、GPS数据，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；
偏航角角速度修正量模块112，用于根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；
第一偏航角角速度误差值模块113，用于根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；
初始互补融合偏航角角速度模块114，用于根据所述IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；
第二偏航角角速度误差值模块115，用于根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；
最终互补融合偏航角模块116，用于根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。
在本发明实施例中，所述偏航角角速度修正量模块112，具体用于：
根据所述GPS数据，获取所述飞行器当前位置的磁场向量；
根据所述磁力计数据，确定磁力计的磁场向量；
根据所述飞行器当前位置的磁场向量以及所述磁力计的磁场向量，计算磁北极误差角；
根据所述磁北极误差角，确定所述偏航角角速度修正量。
在本发明实施例中，所述第一偏航角角速度误差值模块113，具体用于：
对所述IMU数据进行坐标变换，生成地面坐标系下的IMU加速度信息；
对所述GPS数据进行信号处理，生成水平加速度信息；
对所述地面坐标系下的IMU加速度信息以及所述水平加速度信息求矢量夹角，将所述矢量夹角作为所述第一偏航角角速度误差值。
在本发明实施例中，所述初始互补融合偏航角角速度模块114，具体用于：
对所述地面坐标系下的IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值进行求和，将求和结果作为所述初始互补融合偏航角角速度。
在本发明实施例中，所述第二偏航角角速度误差值模块115，具体用于：
对所述IMU加速度信息进行积分，以生成积分IMU速度信息；
对所述积分IMU速度信息进行归一化处理，生成归一化IMU速度信息；
对所述GPS速度信息进行归一化处理，生成归一化GPS速度信息；
根据所述归一化IMU速度信息以及所述归一化GPS速度信息，生成速度差值；
对所述速度差值进行微分，生成第二偏航角角速度误差值。
在本发明实施例中，所述装置还包括：
静止标志位模块，用于根据所述IMU数据，生成静止标志位，其中，所述静止标志位用于反映所述飞行器是否处于静止状态；
IMU偏移数据差值模块，用于根据所述IMU数据和所述静止标志位，获得IMU数据的偏移数据；获取所述IMU数据和所述IMU数据的偏移数据的差值；
所述第一偏航角角速度误差值模块，具体用于：
对所述IMU数据和所述IMU数据的偏移数据的差值进行坐标变换，以生成地面坐标系下的所述IMU加速度信息。
请再参阅图12，图12是图11中的最终互补融合偏航角模块的示意图；
如图12所示，所述最终互补融合偏航角模块116，包括：
第一角速度差值单元1161，用于计算所述初始互补融合偏航角角速度与上一时刻的最终互补融合偏航角的差值，确定第一角速度差值；
第二角速度差值单元1162，用于计算所述第二偏航角角速度误差值与上一时刻的最终互补融合偏航角的差值，确定第二角速度差值；
权重单元1163，用于根据所述第一角速度差值以及第二角速度差值，确定第一权重和第二权重；
权重比例系数单元1164，用于对所述第一权重和第二权重进行归一化处理，生成第一权重比例系数以及第二权重比例系数；
第一乘积值单元1165，用于对所述初始互补融合偏航角角速度以及所述第一权重比例系数进行求积，生成第一乘积值；
第二乘积值单元1166，用于对所述第二偏航角角速度误差值以及所述第二权重比例系数进行求积，生成第二乘积值；
最终互补融合偏航角单元1167，用于根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角。
请参阅图13，图13是本发明实施例提供一种飞行器的硬件结构示意图。其中，该飞行器可以是无人飞行器(unmanned aerial vehicle，UAV)，无人飞船等电子设备。
如图13所示，该飞行器1300包括一个或多个处理器1301以及存储器1302。其中，图13中以一个处理器1301为例。
处理器1301和存储器1302可以通过总线或者其他方式连接，图13中以通过总线连接为例。
存储器1302作为一种非易失性计算机可读存储介质，可用于存储非易失性软件程序、非易失性计算机可执行程序以及模块，如本发明实施例中的一种偏航角的融合方法对应的单元(例如，图11至图12所述的各个模块或单元)。处理器1301通过运行存储在存储器1302中的非易失性软件程序、指令以及模块，从而执行偏航角的融合方法的各种功能应用以及数据处理，即实现上述方法实施例偏航角的融合方法以及上述装置实施例的各个模块和单元的功能。
存储器1302可以包括高速随机存取存储器，还可以包括非易失性存储器，例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实施例中，存储器1302可选包括相对于处理器1301远程设置的存储器，这些远程存储器可以通过网络连接至处理器1301。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
所述模块存储在所述存储器1302中，当被所述一个或者多个处理器1301执行时，执行上述任意方法实施例中的偏航角的融合方法，例如，执行以上描述的图5至图10所示的各个步骤；也可实现图11至图12所述的各个模块或单元的功能。
请参阅图14和图15，所述飞行器1300还包括动力装置1303，所述动力装置1303用于飞行器提供飞行动力，所述动力装置1303与处理器1301连接。所述动力装置1303包括：驱动电机13031及电调13032，所述电调13032与驱动电机13031电连接，用于控制所述驱动电机13031。具体的，所述电调13032基于处理器1301执行上述偏航角的融合方法后得到的融合偏航角，生成控制指令，通过控制指令控制该驱动电机13031。
所述飞行器1300可执行本发明实施例一所提供的偏航角的融合方法，具备执行方法相应的功能模块和有益效果。未在飞行器实施例中详尽描述的技术细节，可参见本发明实施例一所提供的偏航角的融合方法。
本发明实施例提供了一种计算机程序产品，所述计算机程序产品包括存储在非易失性计算机可读存储介质上的计算机程序，所述计算机程序包括程序指令，当所述程序指令被计算机执行时，使所述计算机执行如上所述的偏航角的融合方法。例如，执行以上描述的图5中的方法步骤S10至步骤S60。
本发明实施例还提供了一种非易失性计算机存储介质，所述计算机存储介质存储有计算机可执行指令，该计算机可执行指令被一个或多个处理器执行，例如图13中的一个处理器1301，可使得上述一个或多个处理器可执行上述任意方法实施例中的偏航角的融合方法，例如，执行上述任意方法实施例中的偏航角的融合方法，例如，执行以上描述的图5至图10所示的各个步骤；也可实现图11至图12所述的各个模块或单元的功能。
在本发明实施例中，通过提供一种偏航角的融合装置，应用于飞行器，所述装置包括：获取模块，用于获取磁力计数据、IMU数据以及GPS数据，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；偏航角角速度修正量模块，用于根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；第一偏航角角速度误差值模块，用于根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；初始互补融合偏航角角速度模块，用于根据所述IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；第二偏航角角速度误差值模块，用于根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；最终互补融合偏航角模块，用于根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。通过上述方式，本发明实施例解决一次互补滤波误差较大的技术问题，提高偏航角的融合精度以及稳定性。
以上所描述的装置或设备实施例仅仅是示意性的，其中所述作为分离部件说明的单元模块可以是或者也可以不是物理上分开的，作为模块单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络模块单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
通过以上的实施方式的描述，本领域的技术人员可以清楚地了解到各实施方式可借助软件加通用硬件平台的方式来实现，当然也可以通过硬件。基于这样的理解，上述技术方案本质上或者说对相关技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品可以存储在计算机可读存储介质中，如ROM/RAM、磁碟、光盘等，包括若干指令用直至得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。
最后应说明的是：以上实施例仅用以说明本发明的技术方案，而非对其限制；在本发明的思路下，以上实施例或者不同实施例中的技术特征之间也可以进行组合，步骤可以以任意顺序实现，并存在如上所述的本发明的不同方面的许多其它变化，为了简明，它们没有在细节中提供；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本申请各实施例技术方案的范围。
Claims (17)
1.一种偏航角的融合方法，应用于飞行器，其特征在于，所述方法包括：
获取磁力计数据、IMU数据以及GPS数据，其中，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；
根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；
根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；
根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；
根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；
根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。
2.根据权利要求1所述的方法，其特征在于，所述根据所述GPS数据以及所述磁力计数据，确定所述偏航角角速度修正量，包括：
根据所述GPS数据，获取所述飞行器当前位置的磁场向量；
根据所述磁力计数据，确定磁力计的磁场向量；
根据所述飞行器当前位置的磁场向量以及所述磁力计的磁场向量，计算磁北极误差角；
根据所述磁北极误差角，确定所述偏航角角速度修正量。
3.根据权利要求1所述的方法，其特征在于，所述根据所述IMU加速度信息以及所述GPS加速度信息，确定所述第一偏航角角速度误差值，包括：
对所述IMU数据进行坐标变换，以生成地面坐标系下的IMU加速度信息；
对所述GPS数据进行信号处理，以生成水平加速度信息；
对所述地面坐标系下的IMU加速度信息以及所述水平加速度信息求矢量夹角，将所述矢量夹角作为所述第一偏航角角速度误差值。
4.根据权利要求3所述的方法，其特征在于，在对所述IMU数据进行坐标变换，以生成地面坐标系下的所述IMU加速度信息之前,该方法还包括:
根据所述IMU数据，生成静止标志位，其中，所述静止标志位用于反映所述飞行器是否处于静止状态；
根据所述IMU数据和所述静止标志位，获得IMU数据的偏移数据；
获取所述IMU数据和所述IMU数据的偏移数据的差值；则，
所述对所述IMU数据进行坐标变换，以生成地面坐标系下的所述IMU加速度信息，包括：
对所述IMU数据和所述IMU数据的偏移数据的差值进行坐标变换，以生成地面坐标系下的所述IMU加速度信息。
5.根据权利要求3或4所述的方法，其特征在于，所述根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定所述初始互补融合偏航角角速度，包括：
对所述地面坐标系下的IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值进行求和，将求和结果作为所述初始互补融合偏航角角速度。
6.根据权利要求1所述的方法，其特征在于，所述根据所述IMU加速度信息以及所述GPS速度信息，确定所述第二偏航角角速度误差值，包括：
对所述IMU加速度信息进行积分，以生成积分IMU速度信息；
对所述积分IMU速度信息进行归一化处理，生成归一化IMU速度信息；
对所述GPS速度信息进行归一化处理，生成归一化GPS速度信息；
根据所述归一化IMU速度信息以及所述归一化GPS速度信息，生成速度差值；
对所述速度差值进行微分，生成所述第二偏航角角速度误差值。
7.根据权利要求1所述的方法，其特征在于，所述根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定所述最终互补融合偏航角，包括：
计算所述初始互补融合偏航角角速度与上一时刻的最终互补融合偏航角的差值，以确定第一角速度差值；
计算所述第二偏航角角速度误差值与所述上一时刻的最终互补融合偏航角的差值，以确定第二角速度差值；
根据所述第一角速度差值以及所述第二角速度差值，确定第一权重和第二权重；
对所述第一权重和所述第二权重进行归一化处理，以生成第一权重比例系数以及第二权重比例系数；
对所述初始互补融合偏航角角速度以及所述第一权重比例系数进行求积，以生成第一乘积值；
对所述第二偏航角角速度误差值以及所述第二权重比例系数进行求积，以生成第二乘积值；
根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角。
8.根据权利要求7所述的方法，其特征在于，所述根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角，包括：
对所述第一权重和所述第二权重进行求和，以生成权重和；
对所述第一乘积值和所述第二乘积值进行求和，以生成乘积和；
根据所述权重和以及所述乘积和，确定所述最终互补融合偏航角。
9.一种偏航角的融合装置，应用于飞行器，其特征在于，所述装置包括：
获取模块，用于获取磁力计数据、IMU数据以及GPS数据，其中，所述IMU数据包括IMU加速度信息以及IMU角速度信息，所述GPS数据包括GPS速度信息以及GPS加速度信息；
偏航角角速度修正量模块，用于根据所述GPS数据以及所述磁力计数据，确定偏航角角速度修正量；
第一偏航角角速度误差值模块，用于根据所述IMU加速度信息以及所述GPS加速度信息，确定第一偏航角角速度误差值；
初始互补融合偏航角角速度模块，用于根据所述IMU角速度信息、所述偏航角角速度修正量以及所述第一偏航角角速度误差值，确定初始互补融合偏航角角速度；
第二偏航角角速度误差值模块，用于根据所述IMU加速度信息以及所述GPS速度信息，确定第二偏航角角速度误差值；
最终互补融合偏航角模块，用于根据所述初始互补融合偏航角角速度以及所述第二偏航角角速度误差值，确定最终互补融合偏航角。
10.根据权利要求9所述的装置，其特征在于，所述偏航角角速度修正量模块，具体用于：
根据所述GPS数据，获取所述飞行器当前位置的磁场向量；
根据所述磁力计数据，确定磁力计的磁场向量；
根据所述飞行器当前位置的磁场向量以及所述磁力计的磁场向量，计算磁北极误差角；
根据所述磁北极误差角，确定所述偏航角角速度修正量。
11.根据权利要求9所述的装置，其特征在于，所述第一偏航角角速度误差值模块，具体用于：
对所述IMU数据进行坐标变换，以生成地面坐标系下的IMU加速度信息；
对所述GPS数据进行信号处理，以生成水平加速度信息；
对所述地面坐标系下的IMU加速度信息以及所述水平加速度信息求矢量夹角，将所述矢量夹角作为所述第一偏航角角速度误差值。
12.根据权利要求11所述的装置，其特征在于，所述装置还包括：
静止标志位模块，用于根据所述IMU数据，生成静止标志位，其中，所述静止标志位用于反映所述飞行器是否处于静止状态；
IMU偏移数据差值模块，用于根据所述IMU数据和所述静止标志位，获得IMU数据的偏移数据；获取所述IMU数据和所述IMU数据的偏移数据的差值；
所述第一偏航角角速度误差值模块，具体用于：
对所述IMU数据和所述IMU数据的偏移数据的差值进行坐标变换，以生成地面坐标系下的所述IMU加速度信息。
13.根据权利要求11所述的装置，其特征在于，所述初始互补融合偏航角角速度模块，具体用于：
对所述地面坐标系下的IMU角速度信息、偏航角角速度修正量以及所述第一偏航角角速度误差值进行求和，将求和结果作为所述初始互补融合偏航角角速度。
14.根据权利要求9所述的装置，其特征在于，所述第二偏航角角速度误差值模块，具体用于：
对所述IMU加速度信息进行积分，以生成积分IMU速度信息；
对所述积分IMU速度信息进行归一化处理，生成归一化IMU速度信息；
对所述GPS速度信息进行归一化处理，生成归一化GPS速度信息；
根据所述归一化IMU速度信息以及所述归一化GPS速度信息，生成速度差值；
对所述速度差值进行微分，生成所述第二偏航角角速度误差值。
15.根据权利要求9所述的装置，其特征在于，所述最终互补融合偏航角模块，包括：
第一角速度差值单元，用于计算所述初始互补融合偏航角角速度与上一时刻的最终互补融合偏航角的差值，以确定第一角速度差值；
第二角速度差值单元，用于计算所述第二偏航角角速度误差值与所述上一时刻的最终互补融合偏航角的差值，以确定第二角速度差值；
权重单元，用于根据所述第一角速度差值以及所述第二角速度差值，确定第一权重和第二权重；
权重比例系数单元，用于对所述第一权重和所述第二权重进行归一化处理，以生成第一权重比例系数以及第二权重比例系数；
第一乘积值单元，用于对所述初始互补融合偏航角角速度以及所述第一权重比例系数进行求积，以生成第一乘积值；
第二乘积值单元，用于对所述第二偏航角角速度误差值以及所述第二权重比例系数进行求积，以生成第二乘积值；
最终互补融合偏航角单元，用于根据所述第一乘积值以及所述第二乘积值，确定所述最终互补融合偏航角。
16.根据权利要求15所述的装置，其特征在于，所述最终互补融合偏航角单元，具体用于：
对所述第一权重和所述第二权重进行求和，以生成权重和；
对所述第一乘积值和所述第二乘积值进行求和，以生成乘积和；
根据所述权重和以及所述乘积和，确定所述最终互补融合偏航角。
17.一种飞行器，其特征在于，包括：
机身；
机臂，与所述机身相连；
动力装置，设于所述机臂，用于给所述飞行器提供飞行的动力；以及
飞行控制器，设于所述机身；
其中，所述飞行控制器包括：
至少一个处理器；以及，
与所述至少一个处理器通信连接的存储器；其中，
所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被所述至少一个处理器执行，以使所述至少一个处理器能够执行权利要求1-8任一项所述的方法。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910734158.4A CN110440805B (zh) | 2019-08-09 | 2019-08-09 | 一种偏航角的融合方法、装置及飞行器 |
| PCT/CN2020/106862 WO2021027638A1 (zh) | 2019-08-09 | 2020-08-04 | 一种偏航角的融合方法、装置及飞行器 |
| US17/649,831 US20220155800A1 (en) | 2019-08-09 | 2022-02-03 | Method and apparatus for yaw fusion and aircraft |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910734158.4A CN110440805B (zh) | 2019-08-09 | 2019-08-09 | 一种偏航角的融合方法、装置及飞行器 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110440805A true CN110440805A (zh) | 2019-11-12 |
| CN110440805B CN110440805B (zh) | 2021-09-21 |
Family
ID=68434368
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910734158.4A Active CN110440805B (zh) | 2019-08-09 | 2019-08-09 | 一种偏航角的融合方法、装置及飞行器 |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US20220155800A1 (zh) |
| CN (1) | CN110440805B (zh) |
| WO (1) | WO2021027638A1 (zh) |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110794877A (zh) * | 2019-11-22 | 2020-02-14 | 北京理工大学 | 一种车载摄像头云台伺服系统及控制方法 |
| CN111290415A (zh) * | 2019-12-04 | 2020-06-16 | 中国人民解放军海军航空大学 | 一种基于近似差分的飞行器综合前置导引方法 |
| CN111475770A (zh) * | 2020-04-08 | 2020-07-31 | 成都路行通信息技术有限公司 | 一种三轴加速度坐标系分量修正方法和系统 |
| CN112256052A (zh) * | 2020-09-14 | 2021-01-22 | 北京三快在线科技有限公司 | 无人机的速度控制方法、装置、无人机和存储介质 |
| WO2021027638A1 (zh) * | 2019-08-09 | 2021-02-18 | 深圳市道通智能航空技术有限公司 | 一种偏航角的融合方法、装置及飞行器 |
| CN113870367A (zh) * | 2021-12-01 | 2021-12-31 | 腾讯科技（深圳）有限公司 | 相机外参的生成方法、装置、设备、存储介质和程序产品 |
| CN113992846A (zh) * | 2021-10-19 | 2022-01-28 | 上海艾为电子技术股份有限公司 | 姿态角的获取方法、防抖控制方法以及移动终端 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20130088368A (ko) * | 2012-01-31 | 2013-08-08 | 한국항공우주산업 주식회사 | 고 신뢰도의 속도 유지모드 자동 작동을 제공하는 비행체 제어 방법 및 그 방법을 구현하기 위한 프로그램을 기록한 컴퓨터 판독가능한 기록매체 |
| CN105511484A (zh) * | 2015-11-27 | 2016-04-20 | 深圳一电航空技术有限公司 | 控制无人机稳定飞行的方法及装置 |
| CN105651242A (zh) * | 2016-04-05 | 2016-06-08 | 清华大学深圳研究生院 | 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法 |
| CN108549399A (zh) * | 2018-05-23 | 2018-09-18 | 深圳市道通智能航空技术有限公司 | 飞行器偏航角修正方法、装置及飞行器 |
| CN108917754A (zh) * | 2018-05-21 | 2018-11-30 | 江苏理工学院 | 一种旋翼飞行器速度信号融合滤波方法 |
| CN109001787A (zh) * | 2018-05-25 | 2018-12-14 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6442481B2 (en) * | 2000-07-28 | 2002-08-27 | Honeywell International Inc. | Second order complementary global positioning system/inertial navigation system blending filter |
| FR2917175B1 (fr) * | 2007-06-08 | 2010-04-16 | Eurocopter France | Procede et systeme d'estimation de la vitesse angulaire d'un mobile |
| JP5602070B2 (ja) * | 2011-03-15 | 2014-10-08 | 三菱電機株式会社 | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム |
| CN103217174B (zh) * | 2013-04-10 | 2016-03-09 | 哈尔滨工程大学 | 一种基于低精度微机电系统的捷联惯导系统初始对准方法 |
| US9709405B2 (en) * | 2015-11-23 | 2017-07-18 | Honeywell International Inc. | Methods for attitude and heading reference system to mitigate vehicle acceleration effects |
| CN105928515B (zh) * | 2016-04-19 | 2019-03-29 | 成都翼比特自动化设备有限公司 | 一种无人机导航系统 |
| US10634692B2 (en) * | 2017-04-10 | 2020-04-28 | Rosemount Aerospace Inc. | Inertially-aided air data computer altitude |
| CN109916395B (zh) * | 2019-04-04 | 2023-06-23 | 山东智翼航空科技有限公司 | 一种姿态自主冗余组合导航算法 |
| CN110440805B (zh) * | 2019-08-09 | 2021-09-21 | 深圳市道通智能航空技术股份有限公司 | 一种偏航角的融合方法、装置及飞行器 |
-
2019
- 2019-08-09 CN CN201910734158.4A patent/CN110440805B/zh active Active
-
2020
- 2020-08-04 WO PCT/CN2020/106862 patent/WO2021027638A1/zh active Application Filing
-
2022
- 2022-02-03 US US17/649,831 patent/US20220155800A1/en active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20130088368A (ko) * | 2012-01-31 | 2013-08-08 | 한국항공우주산업 주식회사 | 고 신뢰도의 속도 유지모드 자동 작동을 제공하는 비행체 제어 방법 및 그 방법을 구현하기 위한 프로그램을 기록한 컴퓨터 판독가능한 기록매체 |
| CN105511484A (zh) * | 2015-11-27 | 2016-04-20 | 深圳一电航空技术有限公司 | 控制无人机稳定飞行的方法及装置 |
| CN105651242A (zh) * | 2016-04-05 | 2016-06-08 | 清华大学深圳研究生院 | 一种基于互补卡尔曼滤波算法计算融合姿态角度的方法 |
| CN108917754A (zh) * | 2018-05-21 | 2018-11-30 | 江苏理工学院 | 一种旋翼飞行器速度信号融合滤波方法 |
| CN108549399A (zh) * | 2018-05-23 | 2018-09-18 | 深圳市道通智能航空技术有限公司 | 飞行器偏航角修正方法、装置及飞行器 |
| CN109001787A (zh) * | 2018-05-25 | 2018-12-14 | 北京大学深圳研究生院 | 一种姿态角解算与定位的方法及其融合传感器 |
Non-Patent Citations (1)
| Title |
|---|
| 张晓明等: "航向机动环境中基于陀螺/地磁信息融合的滚转角解算算法", 《弹道学报》 * |
Cited By (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2021027638A1 (zh) * | 2019-08-09 | 2021-02-18 | 深圳市道通智能航空技术有限公司 | 一种偏航角的融合方法、装置及飞行器 |
| CN110794877A (zh) * | 2019-11-22 | 2020-02-14 | 北京理工大学 | 一种车载摄像头云台伺服系统及控制方法 |
| CN110794877B (zh) * | 2019-11-22 | 2020-10-13 | 北京理工大学 | 一种车载摄像头云台伺服系统及控制方法 |
| CN111290415A (zh) * | 2019-12-04 | 2020-06-16 | 中国人民解放军海军航空大学 | 一种基于近似差分的飞行器综合前置导引方法 |
| CN111290415B (zh) * | 2019-12-04 | 2023-04-07 | 中国人民解放军海军航空大学 | 一种基于近似差分的飞行器综合前置导引方法 |
| CN111475770A (zh) * | 2020-04-08 | 2020-07-31 | 成都路行通信息技术有限公司 | 一种三轴加速度坐标系分量修正方法和系统 |
| CN111475770B (zh) * | 2020-04-08 | 2023-04-14 | 成都路行通信息技术有限公司 | 一种三轴加速度坐标系分量修正方法和系统 |
| CN112256052A (zh) * | 2020-09-14 | 2021-01-22 | 北京三快在线科技有限公司 | 无人机的速度控制方法、装置、无人机和存储介质 |
| CN112256052B (zh) * | 2020-09-14 | 2024-03-12 | 北京三快在线科技有限公司 | 无人机的速度控制方法、装置、无人机和存储介质 |
| CN113992846A (zh) * | 2021-10-19 | 2022-01-28 | 上海艾为电子技术股份有限公司 | 姿态角的获取方法、防抖控制方法以及移动终端 |
| CN113870367A (zh) * | 2021-12-01 | 2021-12-31 | 腾讯科技（深圳）有限公司 | 相机外参的生成方法、装置、设备、存储介质和程序产品 |
| CN113870367B (zh) * | 2021-12-01 | 2022-02-25 | 腾讯科技（深圳）有限公司 | 相机外参的生成方法、装置、设备、存储介质和程序产品 |
Also Published As
| Publication number | Publication date |
|---|---|
| WO2021027638A1 (zh) | 2021-02-18 |
| US20220155800A1 (en) | 2022-05-19 |
| CN110440805B (zh) | 2021-09-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110440805A (zh) | 一种偏航角的融合方法、装置及飞行器 | |
| CN108549399A (zh) | 飞行器偏航角修正方法、装置及飞行器 | |
| AU2014373639B2 (en) | Platform stabilization system | |
| CN109000612B (zh) | 设备的角度估算方法、装置、摄像组件及飞行器 | |
| WO2019223270A1 (zh) | 云台电机角度和角速度估算方法、装置、云台及飞行器 | |
| Grip et al. | Flight control system for NASA's Mars helicopter | |
| CN110377058A (zh) | 一种飞行器的偏航角修正方法、装置及飞行器 | |
| CN108780331B (zh) | 云台控制方法和设备、云台以及无人机 | |
| US8620496B2 (en) | Systems and method of controlling a spacecraft using attitude sensors | |
| CN110487277B (zh) | 一种偏航角的融合方法、装置及飞行器 | |
| Windau et al. | Multilayer real-time video image stabilization | |
| WO2021052334A1 (zh) | 一种无人飞行器的返航方法、装置及无人飞行器 | |
| CN109269526A (zh) | 基于阻尼网络的旋转式格网惯导水平阻尼方法 | |
| Řezáč | Inertial stabilization, estimation and visual servoing for aerial surveillance | |
| Gaber et al. | Real-time implementation of a robust simplified intelligent proportional–integral control for CubeSat attitude determination system | |
| Wynn | Visual servoing for precision shipboard landing of an autonomous multirotor aircraft system | |
| KR102356227B1 (ko) | 드론 자세 조정 방법 및 장치 | |
| Chodas et al. | Design of the Galileo scan platform control | |
| Gaber et al. | High‐precision attitude determination and control system design and real‐time verification for CubeSats | |
| Lu et al. | Gyro-free attitude observer of rigid body via only time-varying reference vectors | |
| Crisnapati et al. | Enhancing Gimbal Stabilization Using DMP and Kalman Filter: A Low-Cost Approach with MPU6050 Sensor | |
| CN209051578U (zh) | 一种系留无人机机载全向天线稳定系统 | |
| Bhargava | Development of a quadrotor testbed for control and sensor development | |
| Wendel et al. | MAV attitude estimation using low-cost MEMS inertial sensors and GPS | |
| CN116540753A (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 | ||
| CB02 | Change of applicant information |
Address after: 518055 Guangdong city of Shenzhen province Nanshan District Xili Street Xueyuan Road No. 1001 Chi Yuen Building 9 layer B1 Applicant after: Shenzhen daotong intelligent Aviation Technology Co.,Ltd. Address before: 518055 Guangdong city of Shenzhen province Nanshan District Xili Street Xueyuan Road No. 1001 Chi Yuen Building 9 layer B1 Applicant before: AUTEL ROBOTICS Co.,Ltd. |
|
| CB02 | Change of applicant information | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |