一种固定翼无人机环绕飞行的导航方法技术

一种固定翼无人机环绕飞行的导航方法，属于无人机航路规划技术领域。给定环绕点经纬度及环绕半径，计算无人机期望航向与侧偏，得到圆形航路，由环绕点与环绕半径可生成一个以圆形航路为内切圆的方形航路。无人机切入航路后，可沿圆形航路环绕圆心飞行，移动圆心则可使无人机按圆心移动方向螺旋前进。方形航路用于兼顾环绕飞行与防止长时间滚转运动姿态传感器出现零位漂移。有效解决了围绕兴趣点飞行执行任务，或跟踪车辆、船只等慢速移动目标的问题。问题。问题。

【技术实现步骤摘要】
一种固定翼无人机环绕飞行的导航方法


[0001]本专利技术涉及一种固定翼无人机环绕飞行的导航方法，属于无人机航路规划


技术介绍

[0002]固定翼无人机具有飞行速度高，航程远等优点，在现代军事或民用领域都有着极其广泛的应用前景。
[0003]目前固定翼无人机的航路规划中，一般为多点连线的直线航路、定航向飞行或固定滚转角盘旋等方法。此类导航方法运用广泛、简单易用，但对于特殊任务需要围绕兴趣点飞行执行任务，或跟踪车辆、船只等慢速移动目标的情况下，往往需要提前得到兴趣点及车辆或船只确定时间的确定路线，对于突发情况则无法及时规划。固定滚转角盘旋则无法固定盘旋位置，且无人机长时间连续滚转则容易造成姿态传感器的零位漂移。

技术实现思路

[0004]本专利技术解决的技术问题是：克服现有技术的不足，提供了一种固定翼无人机环绕飞行的导航方法，给定环绕点经纬度及环绕半径，计算无人机期望航向与侧偏，得到圆形航路。由环绕点与环绕半径可生成一个以圆形航路为内切圆的方形航路。无人机可沿圆形航路或方形航路环绕给定点飞行。
[0005本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种固定翼无人机环绕飞行的导航方法，其特征在于，无人机飞行时实时接收地面站发送的切入环绕飞行指令、方形航路飞行指令和正常航路飞行指令；若接收到切入环绕飞行指令，则实时循环判断无人机当前位置与切入环绕飞行指令中的环绕中心的距离是否在切入环绕飞行指令中的环绕半径预设距离范围内；若在预设范围内，则按切入环绕飞行指令进入环绕飞行，并计算无人机环绕飞行控制指令，控制无人机按环绕飞行指令中预设圆形航路环绕飞行；若不在预设范围内，则按切入环绕飞行指令进入航向飞行，并计算无人机航向飞行控制指令，控制无人机向环绕飞行指令中预设圆形航路飞行；若接收到方形航路飞行指令，则按方形航路飞行指令进入方形航路飞行，并计算无人机方形航路飞行控制指令，控制无人机按方形航路飞行指令中预设方形航路飞行；若接收到正常航路飞行指令，按正常航路飞行指令进入预设正常航路飞行，并计算无人机正常航路飞行控制指令，控制无人机按正常航路飞行指令中预设正常航路飞行。2.根据权利要求1所述的一种固定翼无人机环绕飞行的导航方法，其特征在于：所述无人机航向飞行控制指令为其中，φ
c
为无人机滚转角指令，为偏航角到滚转角的增益，ψ
c
为航向给定值，ψ为航向实时值。3.根据权利要求2所述的一种固定翼无人机环绕飞行的导航方法，其特征在于，所述无人机环绕飞行控制指令为：人机环绕飞行控制指令为：φ
law
＝φ
trim
+φ
c
；其中，φ
c
为无人机滚转角指令，为偏航角到滚转角的增益，ψ
c
为航向给定值，ψ为航向实时值，v为无人机实时速度，g为重力加速度，R为环绕半径，Z为无人机实时侧偏值，Z
c
为侧偏给定值，φ
trim

【专利技术属性】
技术研发人员：罗继安，
申请(专利权)人：彩虹无人机科技有限公司，
类型：发明
国别省市：