[发明专利]一种应急路径规划方法及装置

说明书

本申请提供一种应急路径规划方法及装置，根据一发失效规范要求(包括最小梯度、水平保护区以及垂直超障余度)及地形障碍物限制构建待规划飞机的真实三维地形图模型；利用MATLAB编程将真实三维地形图模型转换为二维平面地形图模型，并计算得到待规划飞机的障碍物区域；根据障碍物区域的预设条件，建立所述待规划飞机的平面运动模型和超障模型；基于动态窗口法对平面运动模型和超障模型进行计算，并引入评价函数求解待规划飞机的最优路径。本申请能够利用计算机工具自动规划路径，确保安全超障，减少人工工作量，提高工作效率。

技术领域

本申请涉及航空运输业技术领域，特别的，尤其涉及一种应急路径规划方法及装置，应用于一发失效路径规划。

背景技术

近年来，随着航空运输业的迅速发展，复杂地形机场的数量也随之增加，对于复杂机场，其安全与经济的矛盾问题更加严重，一发失效应急程序的重要性也愈显突出。

目前现有的技术中一发失效应急程序工作主要是通过人工手动在画图软件中绘制，并进行障碍物评估，设计工作及计算过程比较复杂且繁琐，对于地形复杂机场工作量大；且在计算过程中容易出现错误或者遗漏重要障碍物。

发明内容

鉴于上述内容中的问题，本申请提供了一种应急路径规划方法及装置，用以简化设计工作及计算过程，避免计算过程中容易出现错误或者遗漏重要障碍物。

为了实现上述目的，本申请提供了以下技术方案：

一种应急路径规划方法，包括：

根据一发失效规范要求及地形障碍物限制构建待规划飞机的真实三维地形图模型，所述一发失效规范要求包括最小梯度、水平保护区以及垂直超障余度；

利用MATLAB编程将所述真实三维地形图模型转换为二维平面地形图模型，并计算得到所述待规划飞机的障碍物区域；

根据所述障碍物区域的预设条件，建立所述待规划飞机的平面运动模型和超障模型；

基于动态窗口法对所述平面运动模型和所述超障模型进行计算，并引入评价函数求解所述待规划飞机的最优路径。

其中，所述利用MATLAB编程对所述真实三维地形图模型转换为二维平面地形图模型，并计算得到所述待规划飞机的障碍物区域，包括：

获取SRTM高程数据，对所述SRTM高程数据进行处理，得到对应的高程离散点；

利用所述MATLAB编程对所述高程离散点进行偏离求解，得到平面障碍物的示意图，结合原始地形障碍物，确定得到所述待规划飞机的障碍物区域。

其中，所述引入评价函数求解所述待规划飞机的最优路径，包括：

通过评价函数选择下一时刻中满足约束的最优速度，最大G(v,w)对应速度最优，评价指标包含方位角、安全距离、速度(线速度和角速度)，评价函数定义为：式中表示当前速度下轨迹方位与目标方位之间的夹角，velocity(v,w)表示当前线速度和角速度，α，β，γ为权值参数。

优选的，在引入评价函数求解所述待规划飞机的最优路径之前，还包括：

通过预设公式对所述待规划飞机进行归一化处理，所述预设公式包括：

其中，n为动态窗口内的所有轨迹，i为当前对应轨迹。

一种应急路径规划装置，包括：

第一处理单元，用于根据一发失效规范要求及地形障碍物限制构建待规划飞机的真实三维地形图模型，所述一发失效规范要求包括最小梯度、水平保护区以及垂直超障余度；

第二处理单元，用于利用MATLAB编程将所述真实三维地形图模型转换为二维平面地形图模型，并计算得到所述待规划飞机的障碍物区域；