CN110377056A - 无人机航向角初值选取方法及无人机 - Google Patents
无人机航向角初值选取方法及无人机 Download PDFInfo
- Publication number
- CN110377056A CN110377056A CN201910764705.3A CN201910764705A CN110377056A CN 110377056 A CN110377056 A CN 110377056A CN 201910764705 A CN201910764705 A CN 201910764705A CN 110377056 A CN110377056 A CN 110377056A
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- course angle
- magnetic field
- initial value
- course
- 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
- 238000004422 calculation algorithm Methods 0.000 title claims description 25
- 230000001133 acceleration Effects 0.000 claims abstract description 75
- 238000000034 method Methods 0.000 claims abstract description 54
- 230000004927 fusion Effects 0.000 claims abstract description 19
- 238000011897 real-time detection Methods 0.000 claims abstract description 16
- 230000015654 memory Effects 0.000 claims description 21
- 238000001514 detection method Methods 0.000 claims description 15
- 238000004891 communication Methods 0.000 claims description 12
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 2
- 230000036544 posture Effects 0.000 description 23
- 238000010586 diagram Methods 0.000 description 15
- 230000001681 protective effect Effects 0.000 description 12
- 230000001052 transient effect Effects 0.000 description 8
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 6
- 238000004364 calculation method Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 5
- 239000002184 metal Substances 0.000 description 5
- 229910052751 metal Inorganic materials 0.000 description 5
- 238000001914 filtration Methods 0.000 description 4
- 230000000007 visual effect Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 230000003247 decreasing effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000006698 induction Effects 0.000 description 3
- 229910052742 iron Inorganic materials 0.000 description 3
- 230000002829 reductive effect Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000004590 computer program Methods 0.000 description 2
- 230000005358 geomagnetic field Effects 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 238000007789 sealing Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 230000005389 magnetism Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 230000036961 partial effect Effects 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 201000009482 yaws Diseases 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0011—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U2201/00—UAVs characterised by their flight controls
- B64U2201/20—Remote controls
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明实施例涉及一种无人机航向角初始值选取方法及无人机。所述方法包括:实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数,然后根据所述飞行高度与所述磁场参数,确定航向角初值;进一步地获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量;进而可根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,为无人机进行数据融合提供了准确的航向角初值,实现了无人机在具有磁干扰的地面环境中起飞,航向角仍具有一定的准确程度,减少了无人机在具有磁干扰地面环境中起飞的炸机概率,提高了飞行安全性。
Description
【技术领域】
本发明涉及无人机技术领域,尤其涉及一种无人机航向角初值选取方法及无人机。
【背景技术】
多旋翼无人机航向控制,直接关系到无人机的飞行稳定性和飞行安全性。无人机滚转、俯仰、偏航三个通道姿态中,偏航角度,即航向角,由磁力计给出初值,其他传感器对其进行后期修正最终得到融合后的航向角。磁力计测量地磁场数据,其给出的三轴磁读数极易受环境影响,所以其给定的初值往往会偏离真正的航向。随着无人机飞行,其他传感器参与航向角融合过程,准确的航向角信息会被获得,当该航向角与磁力计给定的初始航向角具有较大偏差时,飞机会对航向进行大幅度修正,体现在飞行过程中,就是航向角会出现较大的变化,轻则飞斜线,重则出现诸如航向角大幅修正导致的失控炸机。
航向角初始值的准确程度直接影响了多旋翼无人机从起飞到获得多传感器融合航向角这一过程中的飞行安全和飞行品质,因此,如何给定航向角初值,尽量减小和避免初值误差,成为一项重要工作。
【发明内容】
为了解决上述技术问题,本发明实施例提供一种提高无人机的航向角初始值精确度的无人机航向角初值选取方法及无人机。
为解决上述技术问题,本发明实施例提供以下技术方案:一种无人机航向角初值选取方法,应用于无人机,所述无人机航向角初值选取方法包括:
实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数;
根据所述飞行高度与所述磁场参数,确定航向角初值;
获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量;
根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
可选地,所述根据由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,包括:
获取所述无人机中GPS传感器的当前速度精度;
在检测到所述当前速度精度达到预设精度时,根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
可选地,所述根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,包括:
计算所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量之间的夹角;
根据所述夹角,更新所述航向角初值。
可选地,所述实时检测所述无人机在起飞过程中的飞行高度和所述无人机飞行环境中的磁场参数,包括:
实时检测所述无人机的飞行高度是否小于预设的飞行高度阈值;
当所述无人机的飞行高度小于所述飞行高度阈值时,每隔预设时间检测一次所述无人机飞行中的磁场参数。
可选地,所述根据所述飞行高度和所述磁场参数,确定所述航向角初值,包括:
计算每次检测的所述磁场参数的误差;
获取检测到的所述磁场参数的误差最小时所述无人机的航向角,并将所述航向角作为航向角初值。
可选地,所述计算每次检测的所述磁场参数的误差,包括:
获取所述无人机所在位置的经纬度;
根据所述无人机所在位置的经纬度,得到基准磁场参数;
对比所述磁场参数与所述基准磁场参数,以计算所述磁场参数的误差。
可选地,所述磁场参数包括磁场强度和磁场倾角。
可选地,所述飞行高度阈值为1.5-2m。
可选地,所述预设时间为10-30ms。
可选地,所述方法还包括:
将传感器采集的数据与更新后的航向角初值进行数据融合,得到修正后的航向角;
根据所述修正后的航向角,确定所述无人机的航向。
可选地,所述根据所述修正后的航向角,确定所述无人机的航向,包括:
根据当前无人机的姿态和所述修正后的航向角,更新所述无人机的姿态;
根据更新后的所述无人机的姿态,确定所述无人机的航向。
可选地,所述根据当前所述无人机的姿态和所述航向角初值,更新所述无人机的姿态,包括:
获取当前所述无人机的姿态的四元数;
根据所述航向角初值和所述修正后的航向角,得到航向偏角;
根据所述航向偏角,得到以无人机Z轴为转轴的四元数:
通过如下算式,确定更新后的所述无人机的姿态的四元数:
q=r*q0
其中,r为以所述无人机Z轴为转轴的四元数,q0为当前所述无人机的姿态的四元数,q为更新后的所述无人机的姿态的四元数。
可选地,通过如下算式,计算得到以所述无人机Z轴为转轴的四元数
其中,ψ0为所述航向偏角,r为以所述无人机Z轴为转轴的四元数。
可选地,所述实时检测所述无人机的飞行高度和所述无人机飞行中的磁场参数之前,还包括:
所述无人机开机后,初始化所述航向角初值。
为解决上述技术问题,本发明实施例还提供以下技术方案:一种无人机。所述无人机包括:机身;
机臂,与所述机身相连;
动力装置,设于所述机臂,用于给所述无人机提供飞行的动力;以及
飞行控制器,设于所述机身;
其中,所述飞行控制器包括:
至少一个处理器;以及
与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够用于执行如上所述的无人机飞行控制方法。
与现有技术相比较,本发明实施例的提供无人机航向角初始值选取方法可以通过实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数,然后根据所述飞行高度与所述磁场参数,确定航向角初值;进一步地获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量;进而根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,为无人机进行数据融合提供了准确的航向角初值,实现了无人机在具有磁干扰的地面环境中起飞,航向角仍具有一定的准确程度,减少了无人机在具有磁干扰地面环境中起飞的炸机概率,提高了飞行安全性。
【附图说明】
一个或多个实施例通过与之对应的附图中的图片进行示例性说明,这些示例性说明并不构成对实施例的限定,附图中具有相同参考数字标号的元件表示为类似的元件,除非有特别申明,附图中的图不构成比例限制。
图1为本发明实施例的应用环境示意图;
图2为本发明实施例提供的无人机航向角初值选取方法的流程示意图;
图3为本发明另一实施例提供的无人机航向角初值选取方法的流程示意图;
图4是图2中S21的流程示意图;
图5为本发明实施例提供的无人机飞行高度-飞行时间的曲线图;
图6为本发明实施例提供的无人机的磁力计三轴读数-飞行时间的曲线图;
图7是图2中S22的流程示意图;
图8是图7中S221的流程示意图;
图9是图2中S23的流程示意图;
图10是图9中S232的流程示意图;
图11是图3中S26的流程示意图;
图12是图11中S261的流程示意图;
图13为本发明实施例提供的无人机航向角初值选取装置的结构框图;
图14为本发明实施例提供的无人机的结构框图。
【具体实施方式】
为了便于理解本发明,下面结合附图和具体实施例,对本发明进行更详细的说明。需要说明的是,当元件被表述“固定于”另一个元件,它可以直接在另一个元件上、或者其间可以存在一个或多个居中的元件。当一个元件被表述“连接”另一个元件,它可以是直接连接到另一个元件、或者其间可以存在一个或多个居中的元件。本说明书所使用的术语“上”、“下”、“内”、“外”、“底部”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”“第三”等仅用于描述目的,而不能理解为指示或暗示相对重要性。
除非另有定义,本说明书所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本说明书中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是用于限制本发明。本说明书所使用的术语“和/或”包括一个或多个相关的所列项目的任意的和所有的组合。
此外,下面所描述的本发明不同实施例中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合。
本发明实施例提供了一种无人机航向角初值选取方法和装置,所述方法和装置可以通过实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数,然后根据所述飞行高度与所述磁场参数,确定航向角初值;进一步地获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量;进而根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,为无人机进行数据融合提供了准确的航向角初值,实现了无人机在具有磁干扰的地面环境中起飞,航向角仍具有一定的准确程度,减少了无人机在具有磁干扰地面环境中起飞的炸机概率,提高了飞行安全性。
以下举例说明所述无人机航向角初值选取方法和装置的应用环境。
图1是本发明实施例提供的无人机航向角初值选取系统的应用环境的示意图;如图1所示,所述应用场景包括无人机10、无线网络20、智能终端30以及用户40。用户40可操作智能终端30通过无线网络20操控所述无人机10。
无人机10可以是以任何类型的动力驱动的无人飞行载具,包括但不限于旋翼无人机、固定翼无人机、伞翼无人机、扑翼无人机以及直升机模型等。在本实施例中以多旋翼无人机为例进行陈述。
该无人机10可以根据实际情况的需要,具备相应的体积或者动力,从而提供能够满足使用需要的载重能力、飞行速度以及飞行续航里程等。无人机10上还可以添加有一种或者多种传感器,令无人机10能够采集相应的数据。
例如,在本实施例中,该无人机10设置有加速度计、陀螺仪、磁力计、GPS导航仪和视觉传感器中的至少一种传感器。
无人机10还包括飞行控制器,作为无人机飞行和数据传输等的控制核心,整合一个或者多个模块,以执行相应的逻辑控制程序。例如,所述飞行控制器可以用于执行上述无人机航向初值选取方法。
智能终端30可以是任何类型,用以与无人机10建立通信连接的智能装置,例如手机、平板电脑或者智能遥控器等。该智能终端30可以装配有一种或者多种不同的用户40交互装置,用以采集用户40指令或者向用户40展示和反馈信息。
这些交互装置包括但不限于:按键、显示屏、触摸屏、扬声器以及遥控操作杆。例如,智能终端30可以装配有触控显示屏,通过该触控显示屏接收用户40对无人机10的遥控指令并通过触控显示屏向用户40展示航拍获得的图像信息,用户40还可以通过遥控触摸屏切换显示屏当前显示的图像信息。
在一些实施例中,无人机10与智能终端30之间还可以融合现有的图像视觉处理技术,进一步的提供更智能化的服务。例如无人机10可以通过双光相机采集图像的方式,由智能终端30对图像进行解析,从而实现用户40对于无人机10的手势控制。
无线网络20可以是基于任何类型的数据传输原理,用于建立两个节点之间的数据传输信道的无线通信网络,例如位于不同信号频段的蓝牙网络、WiFi网络、无线蜂窝网络或者其结合。
图2为本发明实施例提供的无人机航向角初值选取方法的实施例。如图2所示,该无人机航向角初值选取方法可以由无人机的飞行控制器执行,包括如下步骤:
S21、实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数。
具体地,可以采用气压检测装置来检测无人机10的飞行高度,该气压检测装置包括气压计、传感器保护罩及导管,气压计密封设于传感器保护罩内,并连同传感器保护罩安装于无人机10上,导管的一端与传感器保护罩连通,另一端从传感器保护罩穿出后向上延伸。
本发明通过设置传感器保护罩及导管,并将导管的顶端的管口位置设置成向上延伸,以能将气压计的所在外部环境与桨叶旋转产生的扰流进行有效隔离,进而避免气压计受不稳定气压环境的干扰,利于确保气压高度的精确检测。
在一些实施例中,可同时采用气压检测装置、加速度计、GPS和超声波等至少二种传感器,然后使用互补滤波或者卡尔曼滤波融合这些传感器的数据,互相修正,最后得到无人机10的飞行高度。
具体地,采用磁力计检测无人机10飞行环境下的磁场参数,所述磁场参数包括磁场强度和磁场倾角。
S22、根据所述飞行高度和所述磁场参数,更新航向角初值。
具体地,可通过多种传感器获得上述航向角初值,如电子罗盘、磁力计和加速度传感器等,但是上述多种传感器均易受到外界环境的影响,不能准确的获取航向角,影响了姿态估算的稳定性和可靠性,由于此类误差是随机的,无法预先消除。例如,磁力计易受周围环境(如高压线、铁矿厂等)所产生的磁场干扰,从而影响航向角的输出。又例如,地面的波动及无人机10本体的抖动等其他原因造成电子罗盘所附载体的颠簸,由电子罗盘得到的航向角显示出较大波动。
在本实施例中,通过检测所述无人机飞行中的磁场参数情况,得到准确度最高的航向角初值来消除外界环境对磁力计的影响,为无人机10进行数据融合提供了更为准确的航向角初值。
在一些实施例中,也可对电子罗盘获取的航向角采用中值法和卡尔曼滤波器进行处理修正,以得到更为精确的航向角。
S23、获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量。
具体地,把位置数据看作是对载体运动的轨迹采样时间序列,对位置数据求微分即可得到由GPS获取的加速度水平分量;可以采用多种微分平滑模型和算法,如采用最小二乘拟合、样条多项式拟合、正交多项式拟合等方法。
具体地,所述加速度计可以测得机体系下三轴加速度分量,其水平两分量可以合成由加速度计获取的加速度水平分量。
S24、根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
本发明实施例提供了一种无人机航向角初值选取方法和装置,所述方法和可以通过实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数,然后根据所述飞行高度与所述磁场参数,确定航向角初值;进一步地获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量;进而根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,为无人机进行数据融合提供了准确的航向角初值,实现了无人机在具有磁干扰的地面环境中起飞,航向角仍具有一定的准确程度,减少了无人机在具有磁干扰地面环境中起飞的炸机概率,提高了飞行安全性。
在一些实施例中,所述检测无人机飞行高度之前,包括:所述无人机开机后,初始化所述航向角初值,所述航向角初值由磁力计给出。
为了根据更新后的所述航向角初值,确定所述无人机的航向,在一些实施例中,请参阅图3,在S24之后,所述方法还包括:
S25:将传感器采集的数据与更新后的航向角初值进行数据融合,得到修正后的航向角。
具体地,上述传感器包括加速度计、磁力计、陀螺仪、定位仪和视觉传感器中的至少一种传感器。
数据融合的技术是对传感器采集的数据进行分析,整理,融合等一系列的操作处理,多传感器融合数据能够实现对航向角初值的修正,从而给出更为准确的航向角数据。
传感器采集的数据与所述航向角初值可采用多种不同的数据融合算法进行处理,例如:加权平均法、归一化加权平均法、卡尔曼滤波和扩展卡尔曼滤波。
在本实施例中,基于加权平均法对多传感器采集的数据进行数据融合。具体地,第一步就要将所要使用到的各种软硬件进行初始化操作,如传感器初始化以及卡尔曼滤波初始化等;第二步要获取IMU里面的数据,再通过这部分数据信息做判断,看是否需要做姿态角补偿,若是需要补偿,具体数值为多少;第三步要获取加速度计、磁力计、陀螺仪、定位仪和视觉传感器等传感器采集的数据,针对这部分数据值,做相关的加权平均操作,把得到的数据值进行卡尔曼滤波,从而产生修正后的航向角。
S26:根据所述修正后的航向角,确定所述无人机的航向。
具体地,在无人机航向确定之前需要建立机体坐标系,所述机体坐标系与所述无人机固联,所述机体坐标系符合右手法则,原点在无人机的重心处,X轴指向无人机前进方向,Y轴由原点指向无人机右侧,Z轴方向根据X、Y轴由右手法则确定。
具体地,可以应用EKF(ExtendedKalman Filter,扩展卡尔曼滤波)方法根据所述修正后的航向角,确定所述无人机的航向。也可根据当前所述无人机10的姿态的四元数和航向偏角,确定所述无人机的航向。在此不做限定。
为了使更新的航向角初值更为精确,需要准确检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数,在一些实施例中,请参阅图4,S21包括如下步骤:
S211:实时检测所述无人机的飞行高度是否小于预设的飞行高度阈值。优选地,所述无人机10的所述飞行高度阈值为1.5-2m,所述飞行高度阈值是由无人机10现有飞行数据基础上得出。
具体地,请一并参阅图5和图6,图5给出了一次飞行中无人机高度信息,图6给出了该飞行中相应的磁力计三轴读数。在本次飞行中,无人机10仅做高度变化,在滚转和俯仰通道不做动作。图5中hAGL代表融合高度,hBaro代表气压计高度。图6中x代表磁力计x轴的磁感应强度读数,y代表磁力计y轴的磁感应强度读数,z轴代表磁力计z轴的磁感应强度读数。对比图5和图6可以看出,随着无人机高度的升高,其磁力计读数也随之变化。分析原因,是由于无人机起飞地面对磁场产生影响,导致磁力计读数变化。通常情况下,起飞地面对磁场的影响普遍存在,在含有金属或其他磁性物体的环境中,这种影响更加剧烈。而以往对无人机10航向角的初值给定,往往是在地面完成的,这就导致了初值的不准确。
结合图5和图6分析可以得出,由于地面环境的不确定会导致磁力计给出的磁场信息不准确,从而导致航向角初值不准确。这种影响与距离的二次方成反比,通过检测无人机实时高度发现,当无人机高度首次达到1.5-2m时,磁力计读数不再发生明显变化,此时起飞地面环境对磁力计的影响已经十分微弱,此时磁力计能够给出更加准确的磁场信息,从而使更新的航向角初始值也更加准确,因此本发明将所述无人机10的所述飞行高度阈值设为1.5-2m。而且通常情况下,无人机飞行高度远高于1.5-2m高度,因此在1.5-2m高度更新航向角初值不会对正常飞行造成影响。
具体地,采用气压检测装置来检测无人机10的飞行高度,该气压检测装置包括气压计、传感器保护罩及导管,气压计密封设于传感器保护罩内,并连同传感器保护罩安装于无人机10上,导管的一端与传感器保护罩连通,另一端从传感器保护罩穿出后向上延伸。本发明通过设置传感器保护罩及导管,并将导管的顶端的管口位置设置成向上延伸,以能将气压计的所在外部环境与桨叶旋转产生的扰流进行有效隔离,进而避免气压计受不稳定气压环境的干扰,利于确保气压高度的精确检测。
S212:当所述无人机的飞行高度小于所述飞行高度阈值时,每隔预设时间检测一次所述无人机飞行中的磁场参数。所述预设时间为10-15ms。
具体地,首先实时获取由上述气压检测装置、加速度计、GPS和超声波等传感器检测的无人机飞行高度。然后对比无人机飞行高度与所述无人机的飞行高度阈值,当所述无人机的飞行高度小于所述飞行高度阈值时,每隔10-15ms通过磁力计检测无人机此时飞行高度下的磁场参数。所述磁场参数包括磁场强度、磁场倾角和磁场偏角中的至少一种。
在一些实施例中,所述预设时间可根据起飞地面环境进行设置,例如当起飞地面环境中含有较多金属或其他磁性物体(如高压线、铁矿厂等),此时起飞地面环境对磁力计所产生的磁场干扰较强,可将所述预设时间减小,比如减小至5-9ms。又例如当起飞地面环境中含有较少金属或其他磁性物体,此时起飞地面环境对磁力计所产生的磁场干扰较弱,可将所述飞行高度阈值减小,比如减小至16-20ms。
为了使更新的航向角初值更为精确,在一些实施例中,请参阅图7,S22包括如下步骤:
S221:计算每次检测的所述磁场参数的误差。
具体地,世界地磁场模型(WMM)为磁力计获取的磁场参数的误差判定提供了一个基准磁场量,WMM是地球主磁场的数学模型,利用该模型可以计算全球任意位置点的地磁场特征量。根据无人机GPS接收机提供的经度、纬度、高度、时间等信息,以及美国国家地球物理数据中心公布的世界地磁场模型WMM,对无人机飞行过程中的磁场进行干扰判定。
在本实施例中,主要从两方面进行分析,一是磁力计测量的当地磁场强度与WMM提供的基准磁场量作对比,一是磁力计测量的当地磁场倾角与WMM提供的基准磁场量作对比。当这两个值出现较大误差时,判定具有磁场干扰。
S222:获取检测到的所述磁场参数的误差最小时所述无人机的航向角,并将所述航向角作为航向角初值。
具体地,所述无人机开机后,通过磁力计读数计算无人机起飞前的磁场参数,并将上述磁场参数作为第一磁场参数。
所述无人机起飞后且所述无人机飞行高度小于所述飞行高度阈值时,每隔预设时间,获取此时无人机飞行高度下的磁场参数,将所述磁场参数作为第二磁场参数,将所述第一磁场参数与所述第二磁场参数做对比,若第二磁场与参数基准磁场量误差小于第一磁场参数与基准磁场量误差,则将所述第二磁场参数替代所述第一磁场参数,即所述第二磁场参数变为第一磁场参数,循环往复,则当所述无人机飞行高度达到所述飞行高度阈值时,此时所述第一磁场参数为最优磁场参数,即所述第一磁场参数与基准磁场量误差最小,获取最优磁场参数对应的所述无人机飞行高度处的航向角,即可获取磁场参数误差最小时对应的所述无人机飞行高度处的航向角。
具体地,所述无人机10的所述飞行高度阈值为1.5-2m,当所述无人机飞行高度达到所述飞行高度阈值时,此时起飞地面环境对磁力计的影响已经十分微弱,此时通过磁力计获取到的航向角更加准确,并将此航向角作为航向角初值,以完成航向角初值的更新。而且通常情况下,无人机飞行高度远高于1.5-2m高度,因此在1.5-2m高度更新航向角初值不会对正常飞行造成影响。
在一些实施例中,所述飞行高度阈值可根据起飞地面环境进行设置,例如当起飞地面环境中含有较多金属或其他磁性物体(如高压线、铁矿厂等),此时起飞地面环境对磁力计所产生的磁场干扰较强,可将所述飞行高度阈值增大,比如增大至3-5m。又例如当起飞地面环境中含有较少金属或其他磁性物体,此时起飞地面环境对磁力计所产生的磁场干扰较弱,可将所述飞行高度阈值减小,比如减小至1-1.4m。
为了准确计算出每隔所述预设时间检测的所述无人机飞行中的磁场参数的误差。在一些实施例中,请参阅图8,S221包括以下步骤:
S2211:获取所述无人机所在位置的经纬度。
具体地,可通过无人机机载的GPS接收机获取所述无人机所在位置的经度、纬度、高度、时间等信息。
S2212:根据所述无人机所在位置的经纬度,得到基准磁场参数。
具体地,根据GPS得到的经纬度查WMM表得到当地的磁场强度,磁场倾角,磁场偏角等信息。
S2213:对比所述磁场参数与所述基准磁场参数,以计算所述磁场参数的误差。
具体地,主要从两方面进行对比,一是磁力计测量的当地磁场强度与WMM提供的基准磁场量作对比,一是磁力计测量的当地磁场倾角与WMM提供的基准磁场量作对比。当这两个值出现较大误差时,判定具有磁场干扰。
为了更好的根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,在一些实施例中,请参阅图9,S23包括如下步骤:
S231:获取所述无人机中GPS传感器的当前速度精度。
具体地,可直接读取无人机机载的GPS传感器转中直接读取当前速度精度。
S232:在检测到所述当前速度精度达到预设精度时,根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
具体的,所述预设精度的范围为0.2-0.5m/s,当前速度精度在所述预设精度的范围内时,根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。当前速度精度不在所述预设精度的范围内时,继续获取所述无人机中GPS传感器的当前速度精度。
为了使更新的航向角初值更为精确,需要根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,在一些实施例中,请参阅图10,S232包括如下步骤:
S2321:计算所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量之间的夹角。
具体地,计算所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量在水平面投影的夹角。
S2322:根据所述夹角,更新所述航向角初值。
具体地,将所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量在水平面投影的夹角替代根据所述飞行高度与所述磁场参数确定的航向角初值,以此实现更新所述航向角初值。
为了根据所述修正后的航向角,更为准确的确定所述无人机的航向,在一些实施例中,请参阅图11,S26包括如下步骤:
S261:根据无人机的当前姿态和所述修正后的航向角,更新所述无人机的姿态。
S262:根据更新后的所述无人机的姿态,确定所述无人机的航向。
为了根据无人机的当前姿态和所述修正后的航向角,准确更新所述无人机的姿态,在一些实施例中,请参阅图12,S261包括如下步骤:
S2611:获取所述无人机的当前姿态的四元数。
S2612:根据所述航向角初值和所述修正后的航向角,得到航向偏角。
S2613:根据所述航向偏角,得到以无人机Z轴为转轴的四元数。
具体地,通过如下算式,计算得到以所述无人机Z轴为转轴的四元数:
其中,ψ0为所述航向偏角,r为以所述无人机Z轴为转轴的四元数。
S2614:通过如下算式,确定更新后的所述无人机的姿态四元数。
q=r*q0;
其中,r为以所述无人机Z轴为转轴的四元数,q0为当前所述无人机的姿态的四元数,q为更新后的所述无人机的姿态四元数。
需要说明的是,在上述各个实施例中,上述各步骤之间并不必然存在一定的先后顺序,本领域普通技术人员,根据本申请实施例的描述可以理解,不同实施例中,上述各步骤可以有不同的执行顺序,亦即,可以并行执行,亦可以交换执行等等。
作为本申请实施例的另一方面,本申请实施例提供一种无人机航向角初值选取装置50。请参阅图13,该无人机航向角初值选取装置50包括:检测模块51、航向角初值确定模块52、加速度获取模块53以及航向角初值更新模块54。
检测模块51用于实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数。
航向角初值确定模块52用于根据飞行高度和所的磁场参数,更新航向角初值。
加速度获取模块53用于获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量。
航向角初值更新模块54用于根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
因此,在本实施例中,通过实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数,然后根据所述飞行高度与所述磁场参数,确定航向角初值;进一步地获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量;进而根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,为无人机进行数据融合提供了准确的航向角初值,实现了无人机在具有磁干扰的地面环境中起飞,航向角仍具有一定的准确程度,减少了无人机在具有磁干扰地面环境中起飞的炸机概率,提高了飞行安全性。
在一些实施例中,无人机航向角初值选取装置50还包括数据融合模块55和航向确定模块56。
数据融合模块55用于将传感器采集的数据与更新后的航向角初值进行数据融合,得到修正后的航向角。
航向确定模块56用于根据所述修正后的航向角,确定所述无人机的航向。
在一些实施例中,无人机航向角初值选取装置50还包括存储模块57,所述存储模块57用于存储飞行高度阈值和预设时间。优选地,所述无人机的所述飞行高度阈值为1.5-2m;所述预设时间为10-30ms。
其中,在一些实施例中,所述航向角初值更新模块54包括速度精度获取单元和航向角初值更新单元;
所述速度精度获取单元用于获取所述无人机中GPS传感器的当前速度精度。
航向角初值更新单元用于在检测到所述当前速度精度达到预设精度时,根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
其中,在一些实施例中,所述航向角初值更新单元包括航向角初值计算子单元和航向角初值替代子单元。
所述括航向角初值计算子单元用于计算所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量之间的夹角。
航向角初值替代子单元用于根据所述夹角,更新所述航向角初值。
其中,在一些实施例中,所述检测模块包括飞行高度检测单元和磁场参数检测单元。
所述高度检测单元用于实时检测所述无人机的飞行高度是否小于预设的飞行高度阈值。
所述磁场参数检测单元用于当所述无人机的飞行高度小于所述飞行高度阈值时,每隔预设时间检测一次所述无人机飞行中的磁场参数。
其中,在一些实施例中,所述航向角初值确定模块52包括误差计算单元和航向角初值确定单元。所述误差计算单元用于计算每次检测的所述磁场参数的误差;所述航向角初值确定单元用于获取检测到的所述磁场参数的误差最小时所述无人机的航向角,并将所述航向角作为航向角初值。
其中,在一些实施例中,所述误差计算单元包括定位子单元、基准磁场参数获取子单元和误差计算子单元;所述定位子单元用于获取所述无人机所在位置的经纬度;所述基准磁场参数获取子单元用于根据所述无人机所在位置的经纬度,得到基准磁场参数;所述误差计算子单元用于对比所述磁场参数与所述基准磁场参数,以计算所述磁场参数的误差。
其中,在一些实施例中,航向确定模块56包括姿态更新单元和航向更新单元。所述姿态更新单元用于根据当前无人机的姿态和所述修正后的航向角,更新所述无人机的姿态;所述航向更新单元用于根据更新后的所述无人机的姿态,确定所述无人机的航向。
其中,姿态更新单元具体用于获取当前所述无人机10的姿态的四元数q0;根据所述航向角初值和所述修正后的航向角,得到航向偏角ψ0;根据所述航向偏角ψ0,得到以所述无人机10的Z轴为转轴的四元数:
根据以所述无人机10的Z轴为转轴的四元数r与当前所述无人机10的姿态的四元数q0,得到新的所述无人机10的姿态q=r*q0。
需要说明的是,上述无人机航向角初值选取装置可执行本发明实施例所提供的无人机航向角初值选取方法,具备执行方法相应的功能模块和有益效果。未在无人机航向角初值选取装置实施例中详尽描述的技术细节,可参见本发明实施例所提供的无人机航向角初值选取方法。
图14为本发明实施例提供的无人机10的结构框图。如图14所示,该无人机10可以包括:机身、机臂、动力装置、磁力计、多种传感器、飞行控制器以及通信模块130。其中,飞行控制器包括处理器110和存储器120。
所述机臂与所述机身相连;所述动力装置设于所述机臂,用于给所述无人机提供飞行的动力。
多种所述传感器用于分别采集相应的飞行数据,多种所述传感器可为加速度计、陀螺仪、磁力计、GPS导航仪和视觉传感器中的多种。
所述处理器110、存储器120以及通信模块130之间通过总线的方式,建立任意两者之间的通信连接。
处理器110可以为任何类型,具备一个或者多个处理核心的处理器110。其可以执行单线程或者多线程的操作,用于解析指令以执行获取数据、执行逻辑运算功能以及下发运算处理结果等操作。
存储器120作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序、非暂态性计算机可执行程序以及模块,如本发明实施例中的无人机航向角初值选取方法对应的程序指令/模块(例如,附图13所示的检测模块51、航向角初值确定模块52、加速度获取模块53、航向角初值更新模块54、数据融合模块55、航向确定模块56、存储模块57)。处理器110通过运行存储在存储器120中的非暂态软件程序、指令以及模块,从而执行无人机航向角初值选取装置50的各种功能应用以及数据处理,即实现上述任一方法实施例中无人机航向角初值选取方法。
存储器120可以包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需要的应用程序;存储数据区可存储根据无人机航向角初值选取装置50的使用所创建的数据等。此外,存储器120可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施例中,存储器120可选包括相对于处理器110远程设置的存储器,这些远程存储器可以通过网络连接至无人机10。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
所述存储器120存储有可被所述至少一个处理器110执行的指令;所述至少一个处理器110用于执行所述指令,以实现上述任意方法实施例中无人机航向角初值选取方法,例如,执行以上描述的方法步骤21、22、23、24等等,实现图13中的模块51-57的功能。
通信模块130是用于建立通信连接,提供物理信道的功能模块。通信模块130以是任何类型的无线或者有线通信模块130,包括但不限于WiFi模块或者蓝牙模块等。
进一步地,本发明实施例还提供了一种非暂态计算机可读存储介质,所述非暂态计算机可读存储介质存储有计算机可执行指令,该计算机可执行指令被一个或多个处理器110执行,例如,被图14中的一个处理器110执行,可使得上述一个或多个处理器110执行上述任意方法实施例中无人机航向角初值选取方法,例如,执行以上描述的方法步骤21、22、23、24等等,实现图13中的模块51-57的功能。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
通过以上的实施方式的描述,本领域普通技术人员可以清楚地了解到各实施方式可借助软件加通用硬件平台的方式来实现,当然也可以通过硬件。本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程是可以通过计算机程序产品中的计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非暂态计算机可读取存储介质中,该计算机程序包括程序指令,当所述程序指令被相关设备执行时,可使相关设备执行上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random Access Memory,RAM)等。
上述产品可执行本发明实施例所提供的无人机航向角初值选取方法,具备执行无人机航向角初值选取方法相应的功能模块和有益效果。未在本实施例中详尽描述的技术细节,可参见本发明实施例所提供的无人机航向角初值选取方法。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;在本发明的思路下,以上实施例或者不同实施例中的技术特征之间也可以进行组合,步骤可以以任意顺序实现,并存在如上所述的本发明的不同方面的许多其它变化,为了简明,它们没有在细节中提供;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (15)
1.一种无人机航向角初值选取方法,应用于无人机,其特征在于,包括:
实时检测所述无人机在起飞过程中的飞行高度与所述无人机飞行环境下的磁场参数;
根据所述飞行高度与所述磁场参数,确定航向角初值;
获取所述无人机在水平飞行过程中由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量;
根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
2.根据权利要求1所述的方法,其特征在于,所述根据由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,包括:
获取所述无人机中GPS传感器的当前速度精度;
在检测到所述当前速度精度达到预设精度时,根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值。
3.根据权利要求2所述的方法,其特征在于,所述根据所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量,更新所述航向角初值,包括:
计算所述由加速度计获取的加速度水平分量和由GPS获取的加速度水平分量之间的夹角;
根据所述夹角,更新所述航向角初值。
4.根据权利要求1至3任一项所述的方法,其特征在于,
所述实时检测所述无人机在起飞过程中的飞行高度和所述无人机飞行环境中的磁场参数,包括:
实时检测所述无人机的飞行高度是否小于预设的飞行高度阈值;
当所述无人机的飞行高度小于所述飞行高度阈值时,每隔预设时间检测一次所述无人机飞行中的磁场参数。
5.根据权利要求4所述的方法,其特征在于,
所述根据所述飞行高度和所述磁场参数,确定所述航向角初值,包括:
计算每次检测的所述磁场参数的误差;
获取检测到的所述磁场参数的误差最小时所述无人机的航向角,并将所述航向角作为航向角初值。
6.根据权利要求5所述的方法,其特征在于,
所述计算每次检测的所述磁场参数的误差,包括:
获取所述无人机所在位置的经纬度;
根据所述无人机所在位置的经纬度,得到基准磁场参数;
对比所述磁场参数与所述基准磁场参数,以计算所述磁场参数的误差。
7.根据权利要求6所述的方法,其特征在于,
所述磁场参数包括磁场强度和磁场倾角。
8.根据权利要求6所述的方法,其特征在于,
所述飞行高度阈值为1.5-2m。
9.根据权利要求6所述的方法,其特征在于,
所述预设时间为10-30ms。
10.根据权利要求1所述的方法,其特征在于,所述方法还包括:
将传感器采集的数据与更新后的航向角初值进行数据融合,得到修正后的航向角;
根据所述修正后的航向角,确定所述无人机的航向。
11.根据权利要求10所述的方法,其特征在于,
所述根据所述修正后的航向角,确定所述无人机的航向,包括:
根据当前无人机的姿态和所述修正后的航向角,更新所述无人机的姿态;
根据更新后的所述无人机的姿态,确定所述无人机的航向。
12.根据权利要求11所述的方法,其特征在于,
所述根据当前所述无人机的姿态和所述航向角初值,更新所述无人机的姿态,包括:
获取当前所述无人机的姿态的四元数;
根据所述航向角初值和所述修正后的航向角,得到航向偏角;
根据所述航向偏角,得到以无人机Z轴为转轴的四元数:
通过如下算式,确定更新后的所述无人机的姿态四元数:
q=r*q0;
其中,r为以所述无人机Z轴为转轴的四元数,q0为当前所述无人机的姿态的四元数,q为更新后的所述无人机的姿态四元数。
13.根据权利要求12所述的方法,其特征在于,通过如下算式,计算得到以所述无人机Z轴为转轴的四元数:
其中,ψ0为所述航向偏角,r为以所述无人机Z轴为转轴的四元数。
14.根据权利要求1所述的方法,其特征在于,
所述检测所述无人机的飞行高度与所述无人机上升飞行中的磁场参数,之前,还包括:
所述无人机开机后,初始化所述航向角初值。
15.一种无人机,其特征在于,包括:
机身;
机臂,与所述机身相连;
动力装置,设于所述机臂,用于给所述无人机提供飞行的动力;以及
飞行控制器,设于所述机身;
其中,所述飞行控制器包括:
至少一个处理器;以及
与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够用于执行如权利要求1-14中任一项所述的无人机飞行控制方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910764705.3A CN110377056B (zh) | 2019-08-19 | 2019-08-19 | 无人机航向角初值选取方法及无人机 |
PCT/CN2020/108928 WO2021031974A1 (zh) | 2019-08-19 | 2020-08-13 | 无人机航向角初值选取方法及无人机 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910764705.3A CN110377056B (zh) | 2019-08-19 | 2019-08-19 | 无人机航向角初值选取方法及无人机 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110377056A true CN110377056A (zh) | 2019-10-25 |
CN110377056B CN110377056B (zh) | 2022-09-20 |
Family
ID=68259811
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910764705.3A Active CN110377056B (zh) | 2019-08-19 | 2019-08-19 | 无人机航向角初值选取方法及无人机 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110377056B (zh) |
WO (1) | WO2021031974A1 (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021031974A1 (zh) * | 2019-08-19 | 2021-02-25 | 深圳市道通智能航空技术有限公司 | 无人机航向角初值选取方法及无人机 |
CN112595317A (zh) * | 2020-10-26 | 2021-04-02 | 一飞(海南)科技有限公司 | 无人机起飞控制方法、系统、介质、计算机设备、无人机 |
CN113740890A (zh) * | 2021-08-31 | 2021-12-03 | 普宙科技(深圳)有限公司 | 一种航向角修正方法、系统、计算机设备及存储介质 |
WO2022063120A1 (zh) * | 2020-09-22 | 2022-03-31 | 深圳市领峰电动智能科技有限公司 | 组合导航系统初始化方法、装置、介质及电子设备 |
CN114355972A (zh) * | 2021-12-27 | 2022-04-15 | 天翼物联科技有限公司 | 通信受限条件下的无人机护航方法、系统、装置及介质 |
CN117387630A (zh) * | 2023-12-12 | 2024-01-12 | 江苏君立华域信息安全技术股份有限公司 | 一种强磁干扰环境下自动方向校正方法及系统 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4930085A (en) * | 1986-10-16 | 1990-05-29 | Litef Gmbh | Method for determining the heading of an aircraft |
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
CN102662083A (zh) * | 2012-03-28 | 2012-09-12 | 北京航空航天大学 | 一种基于gps速度信息的加速度计标定方法 |
CN102692225A (zh) * | 2011-03-24 | 2012-09-26 | 北京理工大学 | 一种用于低成本小型无人机的姿态航向参考系统 |
CN106444809A (zh) * | 2016-10-12 | 2017-02-22 | 湖南绿野航空科技有限公司 | 一种无人机飞行控制器 |
CN106940568A (zh) * | 2017-05-22 | 2017-07-11 | 四川宝天智控系统有限公司 | 飞行控制系统及方法 |
CN108196570A (zh) * | 2017-12-26 | 2018-06-22 | 深圳市道通智能航空技术有限公司 | 一种无人机航向修正方法、装置和无人机 |
US20180180417A1 (en) * | 2013-03-15 | 2018-06-28 | Innovative Solutions & Support, Inc. | Systems and methods for calibrating and adjusting a heading reference system |
JP2018136237A (ja) * | 2017-02-23 | 2018-08-30 | 株式会社国際電気通信基礎技術研究所 | 電磁界データ取得システム、飛行体、端末装置、および、プログラム |
CN108549399A (zh) * | 2018-05-23 | 2018-09-18 | 深圳市道通智能航空技术有限公司 | 飞行器偏航角修正方法、装置及飞行器 |
CN109407696A (zh) * | 2018-09-06 | 2019-03-01 | 南京信息工程大学 | 一种无人机航向角动态校定方法 |
CN110045750A (zh) * | 2019-05-13 | 2019-07-23 | 南京邮电大学 | 一种基于四旋翼无人机的室内场景构建系统及其实现方法 |
CN110109471A (zh) * | 2019-04-23 | 2019-08-09 | 国网浙江省电力有限公司检修分公司 | 一种基于电磁场测距的无人机飞行控制系统及其工作方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005247008A (ja) * | 2004-03-01 | 2005-09-15 | Yamaha Motor Co Ltd | 無人ヘリコプタ用制御装置 |
CN106342284B (zh) * | 2008-08-18 | 2011-11-23 | 西北工业大学 | 一种飞行载体姿态确定方法 |
CN102654404B (zh) * | 2011-03-02 | 2015-05-13 | 浙江中科无线授时与定位研发中心 | 一种提高航姿参考系统解算精度和系统抗干扰能力的方法 |
CN104165642B (zh) * | 2014-08-29 | 2017-02-15 | 东南大学 | 一种用于导航系统航向角直接校正补偿方法 |
CN205311920U (zh) * | 2015-11-19 | 2016-06-15 | 深圳市大疆创新科技有限公司 | 一种无人飞行器 |
CN105352502B (zh) * | 2015-11-26 | 2017-12-12 | 湖北三江航天红峰控制有限公司 | 一种微惯性航姿参考系统的姿态获取方法 |
CN106017459B (zh) * | 2016-05-19 | 2019-03-19 | 极翼机器人(上海)有限公司 | 一种抗磁干扰的方法 |
CN107272718B (zh) * | 2017-06-19 | 2020-07-24 | 歌尔科技有限公司 | 基于卡尔曼滤波的姿态控制方法及装置 |
CN108490972A (zh) * | 2018-03-21 | 2018-09-04 | 深圳臻迪信息技术有限公司 | 飞行器的飞行控制方法、系统以及电子设备 |
CN110377056B (zh) * | 2019-08-19 | 2022-09-20 | 深圳市道通智能航空技术股份有限公司 | 无人机航向角初值选取方法及无人机 |
-
2019
- 2019-08-19 CN CN201910764705.3A patent/CN110377056B/zh active Active
-
2020
- 2020-08-13 WO PCT/CN2020/108928 patent/WO2021031974A1/zh active Application Filing
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4930085A (en) * | 1986-10-16 | 1990-05-29 | Litef Gmbh | Method for determining the heading of an aircraft |
CN101256080A (zh) * | 2008-04-09 | 2008-09-03 | 南京航空航天大学 | 卫星/惯性组合导航系统的空中对准方法 |
CN102692225A (zh) * | 2011-03-24 | 2012-09-26 | 北京理工大学 | 一种用于低成本小型无人机的姿态航向参考系统 |
CN102662083A (zh) * | 2012-03-28 | 2012-09-12 | 北京航空航天大学 | 一种基于gps速度信息的加速度计标定方法 |
US20180180417A1 (en) * | 2013-03-15 | 2018-06-28 | Innovative Solutions & Support, Inc. | Systems and methods for calibrating and adjusting a heading reference system |
CN106444809A (zh) * | 2016-10-12 | 2017-02-22 | 湖南绿野航空科技有限公司 | 一种无人机飞行控制器 |
JP2018136237A (ja) * | 2017-02-23 | 2018-08-30 | 株式会社国際電気通信基礎技術研究所 | 電磁界データ取得システム、飛行体、端末装置、および、プログラム |
CN106940568A (zh) * | 2017-05-22 | 2017-07-11 | 四川宝天智控系统有限公司 | 飞行控制系统及方法 |
CN108196570A (zh) * | 2017-12-26 | 2018-06-22 | 深圳市道通智能航空技术有限公司 | 一种无人机航向修正方法、装置和无人机 |
CN108549399A (zh) * | 2018-05-23 | 2018-09-18 | 深圳市道通智能航空技术有限公司 | 飞行器偏航角修正方法、装置及飞行器 |
CN109407696A (zh) * | 2018-09-06 | 2019-03-01 | 南京信息工程大学 | 一种无人机航向角动态校定方法 |
CN110109471A (zh) * | 2019-04-23 | 2019-08-09 | 国网浙江省电力有限公司检修分公司 | 一种基于电磁场测距的无人机飞行控制系统及其工作方法 |
CN110045750A (zh) * | 2019-05-13 | 2019-07-23 | 南京邮电大学 | 一种基于四旋翼无人机的室内场景构建系统及其实现方法 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021031974A1 (zh) * | 2019-08-19 | 2021-02-25 | 深圳市道通智能航空技术有限公司 | 无人机航向角初值选取方法及无人机 |
WO2022063120A1 (zh) * | 2020-09-22 | 2022-03-31 | 深圳市领峰电动智能科技有限公司 | 组合导航系统初始化方法、装置、介质及电子设备 |
CN112595317A (zh) * | 2020-10-26 | 2021-04-02 | 一飞(海南)科技有限公司 | 无人机起飞控制方法、系统、介质、计算机设备、无人机 |
CN112595317B (zh) * | 2020-10-26 | 2024-05-24 | 一飞(海南)科技有限公司 | 无人机起飞控制方法、系统、介质、计算机设备、无人机 |
CN113740890A (zh) * | 2021-08-31 | 2021-12-03 | 普宙科技(深圳)有限公司 | 一种航向角修正方法、系统、计算机设备及存储介质 |
CN114355972A (zh) * | 2021-12-27 | 2022-04-15 | 天翼物联科技有限公司 | 通信受限条件下的无人机护航方法、系统、装置及介质 |
CN114355972B (zh) * | 2021-12-27 | 2023-10-27 | 天翼物联科技有限公司 | 通信受限条件下的无人机护航方法、系统、装置及介质 |
CN117387630A (zh) * | 2023-12-12 | 2024-01-12 | 江苏君立华域信息安全技术股份有限公司 | 一种强磁干扰环境下自动方向校正方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN110377056B (zh) | 2022-09-20 |
WO2021031974A1 (zh) | 2021-02-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110377056A (zh) | 无人机航向角初值选取方法及无人机 | |
CN110488865A (zh) | 无人机航向确定方法、装置及无人机 | |
WO2021078002A1 (zh) | 无人机航向角初值选取方法、装置及无人机 | |
Mahony et al. | Nonlinear complementary filters on the special orthogonal group | |
CN104567799B (zh) | 基于多传感器信息融合的小型旋翼无人机高度测量方法 | |
CN109238262B (zh) | 一种航向姿态解算及罗盘校准抗干扰方法 | |
CN106774436A (zh) | 基于视觉的旋翼无人机稳定跟踪目标的控制系统及方法 | |
CN110007354B (zh) | 无人机半航空瞬变电磁接收线圈飞行参数测量装置及方法 | |
CN103837151B (zh) | 一种四旋翼飞行器的气动模型辅助导航方法 | |
KR20210129843A (ko) | 무인 비행체 고장 진단 방법 및 장치 | |
CN109683164A (zh) | 一种基于飞行数据的无人机坠落行为识别方法 | |
Wang et al. | Monocular vision and IMU based navigation for a small unmanned helicopter | |
Blachuta et al. | Attitude and heading reference system based on 3D complementary filter | |
CN115727842A (zh) | 一种无人机快速对准方法、系统、计算机设备及存储介质 | |
Filyashkin et al. | Gyro-accelerometric method of determination of angular orientation parameters | |
CN112485811B (zh) | 一种直升机外吊挂物运动测量方法 | |
CN115326062A (zh) | 基于仿生扑翼飞行机器人gnss ins组合导航方法、装置及介质 | |
Lima et al. | Performance evaluation of attitude estimation algorithms in the design of an ahrs for fixed wing uavs | |
Bento | Development and validation of an IMU/GPS/Galileo integration navigation system for UAV | |
CN110785722A (zh) | 对移动平台的参数优化方法、装置及控制设备、飞行器 | |
Shang et al. | Low-cost quadrotor attitude solution based on improved complementary filtering | |
Ye et al. | GNSS-INS-dynamic fusion with robustness to outliers based on external force state estimation | |
Bouffard | An alternative sensor fusion method for object orientation using low-cost MEMS inertial sensors | |
Baraniello et al. | An extension of integrated navigation algorithms to estimate elastic motions of very flexible aircrafts | |
Hoffer et al. | Small low-cost unmanned aerial vehicle system identification: Brief sensor survey and data quality, consistency checking, and reconstruction |
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 |