CN115585814B - 一种基于沉降机制的飞行器变尺度地形跟随方法 - Google Patents

一种基于沉降机制的飞行器变尺度地形跟随方法 Download PDF

Info

Publication number
CN115585814B
CN115585814B CN202211588700.8A CN202211588700A CN115585814B CN 115585814 B CN115585814 B CN 115585814B CN 202211588700 A CN202211588700 A CN 202211588700A CN 115585814 B CN115585814 B CN 115585814B
Authority
CN
China
Prior art keywords
height
track
settleable
aircraft
terrain
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.)
Active
Application number
CN202211588700.8A
Other languages
English (en)
Other versions
CN115585814A (zh
Inventor
李怀建
田维勇
刘莉
张晓辉
贺云涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Technology BIT
Original Assignee
Beijing Institute of Technology BIT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Technology BIT filed Critical Beijing Institute of Technology BIT
Priority to CN202211588700.8A priority Critical patent/CN115585814B/zh
Publication of CN115585814A publication Critical patent/CN115585814A/zh
Application granted granted Critical
Publication of CN115585814B publication Critical patent/CN115585814B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Abstract

本发明公开的一种基于沉降机制的飞行器变尺度地形跟随方法,属于飞行器技术领域。本发明实现方法为:获取平面航迹截面所对应地形高度剖面的最大值,根据该地形高度最大值与起点终点高度,初始化所有航迹点的高度值;将平面航迹从初始高度处开始沉降,考虑安全飞行高度和机动性能约束,选择可沉降高度最小值进行飞行器航迹沉降;兼顾飞行器纵向机动能力和地形复杂程度选择地形跟随尺度,根据选择的地形跟随尺度等间隔设置高度机动点,在二维平面航迹中加入高度引导点,经过高度沉降后获得包含变尺度地形跟随高度引导点的三维航迹,飞行器沿着规划的三维航迹飞行,实现飞行器在不同尺度下对复杂地形的有效跟随,提高飞行器地形复杂地形跟随能力。

Description

一种基于沉降机制的飞行器变尺度地形跟随方法
技术领域
本发明涉及一种基于沉降机制的飞行器变尺度地形跟随方法,属于飞行器技术领域。
背景技术
在飞行器低空突防任务中,地形跟随技术能够使得飞行器与地面保持一定的安全飞行高度,能够利用地形有效提高飞行器的隐身性能,提高低空突防任务的效能。地形跟随技术是有效提高飞行器隐身性能的方法之一。然而由于地形变化复杂和飞行器机动性能有限,在保证安全飞行的前提下,必须要采用高效的地形跟随方法才能进行有效的地形跟随。
现有地形跟随技术通常是飞行器携带激光雷达等距离传感器,通过实时探测与地面的相对当前高度进行动态调整来实现飞行器对地形的跟随。这种地形跟随方法首先需要携带额外的传感器设备,增加了飞行器的重量,并且当地形起伏变化比较大时,由于飞行器只能探测局部地形与飞行器飞行高度的相对高度,会带来一定的滞后性和超调量,导致飞行器处于频繁高度机动中,消耗飞行器所带燃料。因此这种方法更适用于地形变化不大的情况。直接规划飞行器三维地形跟随航迹由于其问题维度高,航迹点数量多以及约束复杂,难以实现飞行器在不同尺度下对复杂地形的有效跟随。
发明内容
针对飞行器变尺度地形跟随三维航迹规划难于实现的问题。本发明主要目的是提供一种基于沉降机制的飞行器变尺度地形跟随方法,利用高度沉降机制将飞行器变尺度地形跟随三维航迹规划解耦为二维航迹规划和纵向高度航迹规划问题,降低飞行器三维航迹规划问题的复杂性;通过兼顾飞行器纵向机动能力和地形复杂程度选择地形跟随尺度,根据选择的地形跟随尺度等间隔设置高度机动点;考虑安全飞行高度和机动性能约束,在二维平面航迹中加入高度引导点,经过高度沉降后获得包含高度信息的三维航迹,飞行器只需沿着所规划的三维航迹飞行,即能够实现飞行器在不同尺度下对复杂地形的有效跟随,提高飞行器地形复杂地形跟随能力。
本发明的目的是通过下述技术方案实现的:
本发明公开的一种基于沉降机制的飞行器变尺度地形跟随方法,在二维平面航迹的基础上,兼顾飞行器纵向机动能力和地形复杂程度选择地形跟随尺度,根据选择的地形跟随尺度等间隔设置高度机动点,生成加入高度机动点的二维平面航迹;获取平面航迹截面所对应地形高度剖面的最大值,根据该地形高度最大值与起点终点高度,初始化所有航迹点的高度值;将平面航迹从初始高度处开始沉降,考虑安全飞行高度和机动性能约束,计算所有航迹点的可沉降高度,选择可沉降高度最小值进行飞行器航迹沉降,直到所有的航迹点均不可沉降为止,输出包含高度的飞行器变尺度地形跟随三维航迹,通过设置地形跟随尺度,在二维平面航迹中加入高度引导点,经过高度沉降后获得包含变尺度地形跟随高度引导点的三维航迹,飞行器只需沿着所规划的三维航迹飞行,即能够实现飞行器在不同尺度下对复杂地形的有效跟随,提高飞行器地形复杂地形跟随能力。
本发明公开的一种基于沉降机制的飞行器地形跟随方法,包括以下步骤:
步骤一:初始化二维航迹、航迹起点高度、航迹终点高度、飞行器水平飞行速度、飞行器纵向机动速度、最小安全飞行高度、地形跟随尺度和地图数据;
所述二维航迹包括航迹点数量n、每个航迹点的坐标(x,y);
所述航迹起点高度h 0
所述航迹终点高度h f
所述飞行器水平飞行速度为v
所述飞行器爬升/下降速度为v h
所述最小安全飞行高度为h safe
所述地图数据为包含任务区域的栅格地图及每个栅格对应的高度值h map
步骤二:兼顾飞行器纵向机动能力和地形复杂程度选择地形跟随尺度d,对二维航迹进行插值处理,按地形跟随尺度d等间距插入高度引导点,根据选择的地形跟随尺度等间隔设置高度机动点,生成加入高度机动点的二位平面航迹;
步骤三:依次查询步骤二所生成二维航迹剖面所对应的地形高度,生成该二维平面航迹所对应的地形高度剖面,并获得地形高度剖面的最大值h max
步骤四:根据航迹起点高度h 0、航迹终点高度h f 以及最大剖面高度h max,将航迹起点和航迹终点的高度分别设置为h 0h f ,令H初始高度表示为h 0h f h 0+h f 中的最大者,将剩余航迹点的高度设置为H,并将航迹起点和终点设置为不可沉降点;
步骤五:计算每一个航迹点所对应的可沉降高度值;考虑安全飞行高度和飞行器纵向机动性能约束,分别计算每一个航迹点的可沉降高度值,该可沉降高度值为安全飞行高度约束下的可沉降高度与纵向机动性能约束下的可沉降高度两者中最小值;
所述安全飞行高度约束下的可沉降高度计算方法为:定义相邻两个航迹点P 1P 2的高度分别为p 1p 2,两点连线间最小地形相对高度为h m ,则两个航迹点P 1P 2在安全飞行高度约束下的可沉降高度分别根据式(1)和式(2)计算:
h y1p 1h m h safe (1)
h y2p 2h m h safe (2)
在式(1)和式(2)中:h y1为航迹点P 1右侧在安全飞行高度约束下的可沉降高度; h y2为航迹点P 2左侧在安全飞行高度约束下的可沉降高度;分别计算航迹点左右两侧在安全飞行高度约束下的可沉降高度,选取该航迹点左右两侧在安全飞行高度约束下的可沉降高度中的最小者作为该航迹点在安全飞行高度约束下的可沉降高度;
只有在该航迹点的左右两侧航迹点存在不可沉降航迹点时,才需要进一步考虑所述纵向机动性能约束下的可沉降高度;飞行器纵向机动性能约束下的可沉降高度计算方式为:根据该航点与相邻不可沉降航点之间的水平距离、飞行器水平速度v和爬升速度v h ,根据式(3)式(4)得到两个航迹点在纵向机动性能约束下的可沉降高度;
Figure 94464DEST_PATH_IMAGE001
(3)
Figure 542762DEST_PATH_IMAGE002
(4)
在式(3)和式(4)中:h r1h r2分别为两个航迹点p 1p 2在纵向机动性能约束下的可 沉降高度;D为两个航点间的水平距离;
Figure 119237DEST_PATH_IMAGE003
为水平速度v和爬升速度v h 的比值;p 2p 1分别两个 航迹点的高度;分别计算航迹点左右两侧在纵向机动性能约束下的可沉降高度,取在纵向 机动性能约束下该航迹点左右两侧可沉降高度值的最小值作为该航迹在纵向机动性能约 束下的可沉降高度;选择该航迹点在纵向机动性能约束下的可沉降高度与安全飞行高度约 束下的可沉降高度中的最小值作为该航迹点的可沉降高度值;
步骤六:根据步骤五计算所有航迹点的可沉降高度值,选择所有航迹点的可沉降高度的最小值作为本次迭代中所有可沉降航迹点的高度沉降值,对所有可沉降航迹点进行高度沉降,航迹点的高度值减少所确定的高度沉降值,不可沉降航迹点的高度值保持不变;所有航迹点高度沉降完成后,将所有可沉降航迹点中可沉降高度等于此次高度沉降值的航迹点设置为不可沉降航迹点;
步骤七:判断所有航迹点中是否存在可沉降航迹点;若存在可沉降点,则转步骤五,重复迭代步骤五至步骤六,直至所有航迹点均为不可沉降航迹,转入步骤八;
步骤八:在二维平面航迹的基础上,经过步骤二至步骤七进行高度沉降后获得每一个航迹点的高度信息,得到包含变尺度地形跟随高度引导点的飞行器三维航迹,飞行器沿着所规划的三维航迹飞行,即能够实现飞行器在不同尺度下对复杂地形的有效跟随,提高飞行器跟随复杂地形的能力;
步骤九:将步骤八规划得到在不同尺度下对复杂地形的飞行器三维航迹,尤其适用于低空巡航飞行器的隐身突防,满足低空巡航飞行器的隐身突防在不同尺度下对复杂地形的高精度、高效率地形跟随要求,提高低空巡航飞行器的隐身突防能力。
有益效果:
1. 飞行器变尺度地形跟随三维航迹规划难于实现。本发明公开的一种基于沉降机制的飞行器变尺度地形跟随方法,利用高度沉降机制,将二维航迹从满足约束的高处逐渐沉降,并在沉降的过程中有效考虑飞行器的安全飞行高度与纵向机动能力,将平面航迹扩展成包含变尺度地形跟随高度引导点的三维航迹,从而获得满足安全飞行高度和纵向机动性能约束的三维地形跟随航迹,即利用高度沉降机制将飞行器变尺度地形跟随三维航迹规划解耦为二维航迹规划和纵向高度航迹规划问题,降低飞行器三维地形跟随航迹规划问题的复杂性,使飞行器变尺度地形跟随三维航迹规划能够实现,在满足三维航迹规划精度的前提下提高航迹规划效率。
2. 本发明公开的一种基于沉降机制的飞行器变尺度地形跟随方法,在二维平面航迹的基础上,兼顾飞行器纵向机动能力和地形复杂程度选择地形跟随尺度,根据选择的地形跟随尺度等间隔设置高度机动点,生成加入高度机动点的二维平面航迹;获取平面航迹截面所对应地形高度剖面的最大值,根据该地形高度最大值与起点终点高度,初始化所有航迹点的高度值;将平面航迹从初始高度处开始沉降,考虑安全飞行高度和机动性能约束,计算所有航迹点的可沉降高度,选择可沉降高度最小值进行飞行器航迹沉降,直到所有的航迹点均不可沉降为止,输出包含高度的飞行器变尺度地形跟随三维航迹,通过设置地形跟随尺度,在二维平面航迹中加入高度引导点,经过高度沉降后获得包含高度信息的三维航迹,飞行器只需沿着所规划的三维航迹飞行,即可实现飞行器在不同尺度下对复杂地形的有效跟随,提高飞行器地形复杂地形跟随能力。
3. 本发明公开的一种基于沉降机制的飞行器变尺度地形跟随方法,规划得到在不同尺度下对复杂地形的飞行器三维航迹,尤其适用于低空巡航飞行器的隐身突防,满足低空巡航飞行器隐身突防在不同尺度下对复杂地形的高精度、高效率地形跟随要求,提高低空巡航飞行器的隐身突防能力。
附图说明
图1为本发明公开的一种基于沉降机制的飞行器变尺度地形跟随方法的流程图;
图2为具体实施例中地形跟随尺度为5km时的地形跟随效果;
图3为具体实施例中地形跟随尺度为10km时的地形跟随效果;
图4为具体实施例中地形跟随尺度为20km时的地形跟随效果。
具体实施方式
为了更好地说明本发明的目的和优点,下面结合飞行器地形跟随仿真实例,结合附图对本发明内容作进一步说明。
实施例1:
为了验证本发明公开的一种基于沉降机制的飞行器变尺度地形跟随方法的可行性与有益效果,下面在实施例中对本发明的技术方案进行清楚、详细地描述,本实施例仿真软件环境为Visual Studio2017版本,硬件环境为台式电脑,配置为Windows10,Intel(R)Core(TM) CPU i7-7500 2.93 GHz,运行16GB。如图1所示。本实例公开的一种基于沉降机制的飞行器变尺度地形跟随方法,具体实现步骤如下:
步骤一:初始化二维航迹、航迹起点高度、航迹终点高度、飞行器水平飞行速度、飞行器纵向机动速度、最小安全飞行高度、地形跟随尺度和地图数据;
所述二维航迹包括航迹点数量n=4、航迹点的坐标分别为(787663,-408463),(656918,-522208),(114349,-457972),(99435,-459546);
所述航迹起点高度h 0=1400m;
所述航迹终点高度h f =500m;
所述飞行器水平飞行速度为v=200m/s;
所述飞行器水平飞行速度为v h =25m/s;
所述最小安全飞行高度为h safe =100m
所述地图数据为包含任务区域的栅格地图大小及每个栅格对应的高度值,并且以地图左上角为坐标原点;
步骤二:兼顾飞行器纵向机动能力和地形复杂程度选择地形跟随尺度,所述地形跟随尺度为分别为5km、10km和20km;对二维航迹进行插值处理,按地形跟随尺度等间距插入高度引导点,根据选择的地形跟随尺度等间隔设置高度机动点,生成加入高度机动点的二维平面航迹;
步骤三:依次查询步骤二所生成二维航迹剖面所对应的地形高度,生成该二维平面航迹所对应的地形高度剖面,并获得地形高度剖面的最大值h max
步骤四:根据航迹起点高度h 0、航迹终点高度h f 以及最大剖面高度h max,将航迹起点和航迹终点的高度分别设置为h 0h f ,令H初始高度表示为h 0h f h 0+h f 中的最大者,将剩余航迹点的高度设置为H,并将航迹起点和终点设置为不可沉降点;
步骤五:计算每一个航迹点所对应的可沉降高度值;考虑安全飞行高度和飞行器纵向机动性能约束,分别计算每一个航迹点的可沉降高度值,该可沉降高度值为安全飞行高度约束下的可沉降高度与纵向机动性能约束下的可沉降高度两者中最小值;
所述安全飞行高度约束下的可沉降高度计算方法为:定义相邻两个航迹点P 1P 2的高度分别为p 1p 2,两点连线间最小地形相对高度为h m ,则两个航迹点P 1P 2在安全飞行高度约束下的可沉降高度分别根据式(5)和式(6)计算:
h y1p 1h m h safe (5)
h y2p 2h m h safe (6)
在式(5)和式(6)中:h y1为航迹点P 1右侧在安全飞行高度约束下的可沉降高度; h y2为航迹点P 2左侧在安全飞行高度约束下的可沉降高度;分别计算航迹点左右两侧在安全飞行高度约束下的可沉降高度,选取该航迹点左右两侧在安全飞行高度约束下的可沉降高度中的最小者作为该航迹点在安全飞行高度约束下的可沉降高度;
只有在该航迹点的左右两侧航迹点存在不可沉降航迹点时,才需要进一步考虑所述纵向机动性能约束下的可沉降高度;飞行器纵向机动性能约束下的可沉降高度计算方式为:根据该航点与相邻不可沉降航点之间的水平距离、飞行器水平速度v和爬升速度v h ,根据式(7)式(8)得到两个航迹点在纵向机动性能约束下的可沉降高度;
Figure 780026DEST_PATH_IMAGE001
(7)
Figure 859977DEST_PATH_IMAGE002
(8)
在式(7)和式(8)中:h r1h r2分别为两个航迹点p 1p 2在纵向机动性能约束下的可 沉降高度;D为两个航点间的水平距离;
Figure 698751DEST_PATH_IMAGE003
为水平速度v和爬升速度v h 的比值;p 2p 1分别两个 航迹点的高度;分别计算航迹点左右两侧在纵向机动性能约束下的可沉降高度,取在纵向 机动性能约束下该航迹点左右两侧可沉降高度值的最小值作为该航迹在纵向机动性能约 束下的可沉降高度;选择该航迹点在纵向机动性能约束下的可沉降高度与安全飞行高度约 束下的可沉降高度中的最小值作为该航迹点的可沉降高度值;
步骤六:根据步骤五计算所有航迹点的可沉降高度值,选择所有航迹点的可沉降高度的最小值作为本次迭代中所有可沉降航迹点的高度沉降值,对所有可沉降航迹点进行高度沉降,航迹点的高度值减少所确定的高度沉降值,不可沉降航迹点的高度值保持不变;所有航迹点高度沉降完成后,将所有可沉降航迹点中可沉降高度等于此次高度沉降值的航迹点设置为不可沉降航迹点;
步骤七:判断所有航迹点中是否存在可沉降航迹点;若存在可沉降点,则转步骤五,重复迭代步骤五至步骤六,直至所有航迹点均为不可沉降航迹,转入步骤八;
步骤八:在二维平面航迹的基础上,经过步骤二至步骤七进行高度沉降后获得每一个航迹点的高度信息,得到包含变尺度地形跟随高度引导点的飞行器三维航迹,飞行器沿着所规划的三维航迹飞行,即能够实现飞行器在不同尺度下对复杂地形的有效跟随,提高飞行器跟随复杂地形的能力;
步骤九:将步骤八规划得到在不同尺度下对复杂地形的飞行器三维航迹,尤其适用于低空巡航飞行器的隐身突防,满足低空巡航飞行器的隐身突防在不同尺度下对复杂地形的高精度、高效率地形跟随要求,提高低空巡航飞行器的隐身突防能力。
基于本实施例公开的一种基于沉降机制的飞行器变尺度地形跟随方法,在跟随尺度分别为5km、10km和20km下的地形跟随效果分别如图2、图3和图4所示。结果表明,利用本发明生成的三维地形跟随航迹始终保持满足安全飞行高度约束的飞行高度,且能够随着地形的变化动态调整自身高度。本发明能够考虑地形变化和飞行器纵向机动性能约束,在不同尺度下对复杂地形进行有效跟随,验证了本发明方法的有效性。进一步分析表明,地形跟随尺度越小,地形跟随效果越好,但飞行器的纵向机动越频繁,导致飞行消耗大量的燃料,而地形跟随尺度越大,飞行器机动次数变小,由于航迹点之间的地形高度变化,导致飞行器对地形的跟随效果较差。
以上的具体描述,是对发明的目的、技术方案和有益效果的进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施实例,仅用于解释本发明,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (1)

1.一种基于沉降机制的飞行器地形跟随方法,其特征在于:包括以下步骤,
步骤一:初始化二维航迹、航迹起点高度、航迹终点高度、飞行器水平飞行速度、飞行器纵向机动速度、最小安全飞行高度、地形跟随尺度和地图数据;
所述二维航迹包括航迹点数量n、每个航迹点的坐标(x,y);
所述航迹起点高度h 0
所述航迹终点高度h f
所述飞行器水平飞行速度为v
所述飞行器纵向机动速度为v h
所述最小安全飞行高度为h safe
所述地图数据为包含任务区域的栅格地图及每个栅格对应的高度值h map
步骤二:兼顾飞行器纵向机动能力和地形复杂程度选择地形跟随尺度d,对二维航迹进行插值处理,按地形跟随尺度d等间距插入高度引导点,根据选择的地形跟随尺度等间隔设置高度机动点,生成加入高度机动点的二维平面航迹;
步骤三:依次查询步骤二所生成二维航迹剖面所对应的地形高度,生成该二维平面航迹所对应的地形高度剖面,并获得地形高度剖面的最大值h max
步骤四:根据航迹起点高度h 0、航迹终点高度h f 以及地形高度剖面的最大值h max,将航迹起点和航迹终点的高度分别设置为h 0h f ,令H初始高度表示为h 0h f h 0+h f 中的最大者,将剩余航迹点的高度设置为H,并将航迹起点和终点设置为不可沉降点;
步骤五:计算每一个航迹点所对应的可沉降高度值;考虑安全飞行高度和飞行器纵向机动性能约束,分别计算每一个航迹点的可沉降高度值,该可沉降高度值为安全飞行高度约束下的可沉降高度与纵向机动性能约束下的可沉降高度两者中最小值;
步骤六:根据步骤五计算所有航迹点的可沉降高度值,选择所有航迹点的可沉降高度的最小值作为本次迭代中所有可沉降航迹点的高度沉降值,对所有可沉降航迹点进行高度沉降,航迹点的高度值减少所确定的高度沉降值,不可沉降航迹点的高度值保持不变;所有航迹点高度沉降完成后,将所有可沉降航迹点中可沉降高度等于此次高度沉降值的航迹点设置为不可沉降航迹点;
步骤七:判断所有航迹点中是否存在可沉降航迹点;若存在可沉降点,则转步骤五,重复迭代步骤五至步骤六,直至所有航迹点均为不可沉降航迹,转入步骤八;
步骤八:在二维平面航迹的基础上,经过步骤二至步骤七进行高度沉降后获得每一个航迹点的高度信息,得到包含变尺度地形跟随高度引导点的飞行器三维航迹,飞行器沿着所规划的三维航迹飞行,即能够实现飞行器在不同尺度下对复杂地形的有效跟随,提高飞行器跟随复杂地形的能力;
步骤九:将步骤八规划得到在不同尺度下对复杂地形的飞行器三维航迹,适用于低空巡航飞行器的隐身突防,满足低空巡航飞行器的隐身突防在不同尺度下对复杂地形的高精度、高效率地形跟随要求,提高低空巡航飞行器的隐身突防能力;
所述安全飞行高度约束下的可沉降高度计算方法为:定义相邻两个航迹点P 1P 2的高度分别为p 1p 2,两点连线间最小地形相对高度为h m ,则两个航迹点P 1P 2在安全飞行高度约束下的可沉降高度分别根据式(1)和式(2)计算:
Figure QLYQS_1
(1)
Figure QLYQS_2
(2)
在式(1)和式(2)中:h y1为航迹点P 1右侧在安全飞行高度约束下的可沉降高度; h y2为航迹点P 2左侧在安全飞行高度约束下的可沉降高度;分别计算航迹点左右两侧在安全飞行高度约束下的可沉降高度,选取该航迹点左右两侧在安全飞行高度约束下的可沉降高度中的最小者作为该航迹点在安全飞行高度约束下的可沉降高度;
只有在该航迹点的左右两侧航迹点存在不可沉降航迹点时,才需要进一步考虑所述纵向机动性能约束下的可沉降高度;飞行器纵向机动性能约束下的可沉降高度计算方式为:根据该航迹点与相邻不可沉降航点之间的水平距离、飞行器水平飞行速度v和飞行器纵向机动速度v h ,根据式(3)式(4)得到两个航迹点在纵向机动性能约束下的可沉降高度;
Figure QLYQS_3
(3)
Figure QLYQS_4
(4)
在式(3)和式(4)中:h r1h r2分别为两个航迹点P 1P 2在纵向机动性能约束下的可沉降高度;D为两个航迹点间的水平距离;飞行器水平飞行速度v和飞行器纵向机动速度v h 的比值;p 2p 1分别为两个航迹点的高度;分别计算航迹点左右两侧在纵向机动性能约束下的可沉降高度,取在纵向机动性能约束下该航迹点左右两侧可沉降高度值的最小值作为该航迹点在纵向机动性能约束下的可沉降高度;选择该航迹点在纵向机动性能约束下的可沉降高度与安全飞行高度约束下的可沉降高度中的最小值作为该航迹点的可沉降高度值。
CN202211588700.8A 2022-12-12 2022-12-12 一种基于沉降机制的飞行器变尺度地形跟随方法 Active CN115585814B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211588700.8A CN115585814B (zh) 2022-12-12 2022-12-12 一种基于沉降机制的飞行器变尺度地形跟随方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211588700.8A CN115585814B (zh) 2022-12-12 2022-12-12 一种基于沉降机制的飞行器变尺度地形跟随方法

Publications (2)

Publication Number Publication Date
CN115585814A CN115585814A (zh) 2023-01-10
CN115585814B true CN115585814B (zh) 2023-03-21

Family

ID=84783416

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211588700.8A Active CN115585814B (zh) 2022-12-12 2022-12-12 一种基于沉降机制的飞行器变尺度地形跟随方法

Country Status (1)

Country Link
CN (1) CN115585814B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116360506B (zh) * 2023-06-02 2023-08-18 深圳高度创新技术有限公司 无人飞行器的路径规划方法、系统、无人飞行器及介质

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2932895B1 (fr) * 2008-06-20 2014-08-08 Thales Sa Procede et systeme d'aide a la navigation aerienne permettant de maintenir des marges verticales
US20120265374A1 (en) * 2011-04-15 2012-10-18 Thomas Edward Yochum Aircraft vertical trajectory optimization method
EP2667366B1 (en) * 2012-05-25 2017-10-04 The Boeing Company Conflict detection and resolution using predicted aircraft trajectories
FR3002657B1 (fr) * 2013-02-22 2015-03-06 Thales Sa Procede d elaboration d un profil vertical de trajectoire comprenant des niveaux d altitude multiples
FR3038380B1 (fr) * 2015-07-03 2017-08-18 Thales Sa Procede et systeme d'affichage de contraintes verticales d'un aeronef, produit programme d'ordinateur et aeronef associes
US10916150B2 (en) * 2018-05-03 2021-02-09 Arkidan Systems Inc. Computer-assisted aerial surveying and navigation
US11081012B2 (en) * 2018-10-15 2021-08-03 The Boeing Company Electronic device and method for optimizing vertical profile for cruise phase of flight
US11257382B2 (en) * 2018-11-28 2022-02-22 The Boeing Company System and method for optimizing a cruise vertical profile subject to a time-of-arrival constraint
FR3089624B1 (fr) * 2018-12-06 2021-03-05 Airbus Operations Sas Procédé et système avionique pour générer une trajectoire verticale optimale
CN110715664B (zh) * 2019-11-05 2021-04-20 大连理工大学 多约束条件下智能无人飞行器航迹快速规划方法
CN114527786A (zh) * 2022-01-06 2022-05-24 南京航空航天大学 一种面向复杂地形低空突防航迹规划的改进动态规划方法
CN114840030A (zh) * 2022-05-24 2022-08-02 四川傲势科技有限公司 无人机仿地飞行航线自动规划方法、无人机及存储介质
CN115145295A (zh) * 2022-07-13 2022-10-04 西北工业大学 一种动态环境下无人机在线自主航迹优化控制方法

Also Published As

Publication number Publication date
CN115585814A (zh) 2023-01-10

Similar Documents

Publication Publication Date Title
CN108416152B (zh) 基于电子海图的无人艇蚁群能耗最优全局路径规划方法
CN108871351B (zh) 一种auv海底地形匹配的动态路径规划方法
CN103557867B (zh) 一种基于稀疏a*搜索的三维多uav协同航迹规划方法
CN110703762A (zh) 一种复杂环境下水面无人艇混合路径规划方法
CN103809597B (zh) 无人机的飞行路径规划方法及无人机
Brown et al. Trajectory optimization for high-altitude long-endurance UAV maritime radar surveillance
CN101118622A (zh) 在城市环境下微型飞行器三维轨迹仿真方法
CN110007670A (zh) 移动机器人定位建图方法
CN111324848B (zh) 移动激光雷达测量系统车载轨迹数据优化方法
CN111580548B (zh) 一种基于样条-rrt和速度障碍的无人机避障方法
CN111065048B (zh) 基于量子风驱动机制的多无人机tdoa三维协同定位方法
CN115585814B (zh) 一种基于沉降机制的飞行器变尺度地形跟随方法
Xu et al. Heuristic and random search algorithm in optimization of route planning for Robot’s geomagnetic navigation
CN112666981A (zh) 基于原鸽群动态群组学习的无人机集群动态航路规划方法
Liu et al. Gravity aided positioning based on real-time ICCP with optimized matching sequence length
CN113551682B (zh) 一种考虑地形与地势影响的两栖无人战车的路径规划方法
Ruddick et al. Design and performance evaluation of an infotaxis-based three-dimensional algorithm for odor source localization
CN114527786A (zh) 一种面向复杂地形低空突防航迹规划的改进动态规划方法
KR101155708B1 (ko) 컴퓨터를 이용한 항공기의 실시간 지형추종 비행경로 생성 방법
CN116182859A (zh) 路径规划方法及装置、设备、存储介质
CN116136417B (zh) 一种面向越野环境的无人驾驶车辆局部路径规划方法
Jiang et al. Research on method of trajectory prediction in aircraft flight based on aircraft performance and historical track data
CN115454061B (zh) 一种基于3d技术的机器人路径避障方法及系统
Ma et al. Volcanic ash region path planning based on improved A-star algorithm
CN110231619B (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
GR01 Patent grant
GR01 Patent grant