[发明专利]一种基于三维目标检测的飞行汽车起飞着陆决策规划方法

说明书

本发明公开了一种基于三维目标检测的飞行汽车起飞着陆决策规划方法，基于部署在飞行汽车上的摄像头和激光雷达实现，该方法包括：根据实时采集的图像和三维点云数据建立动态三维地图；当飞行汽车为飞行状态，根据动态三维地图，分别建立斥力场和引力场形成实时变化的合力场，驱动飞行汽车进行动态着陆，当满足安全距离，控制飞行汽车着陆，决策规划结束；否则，控制飞行汽车上升，重新建立引力场；当飞行汽车为行驶状态，根据动态三维地图，分别建立斥力场和引力场形成实时变化的合力场，驱动飞行汽车起飞，决策规划结束。

技术领域

本发明属于自动驾驶技术领域，尤其涉及一种基于三维目标检测的飞行汽车起飞着陆决策规划方法。

背景技术

美国福特汽车创始人亨利·福特曾预言，飞机和汽车的结合体即将面世。随着城市交通拥堵日益严重，而以飞行汽车为代表的城市空中交通是新的解决方案。多家制造商将2025年前后定为重要的时间节点，飞行汽车将实现商业化。

随之产生两个问题：

1)如何在车水马龙的道路上，让具有初速度的飞行汽车从空中安全汇入车流中；

2)如何让具有初速度的飞行汽车从车水马龙的地面安全的起飞。

从空中汇入车流中的难度比从车流飞到空中难度大得多，起飞场是着陆场的简化形式。

为了解决上述问题，需要解决两个问题环境感知和路径规划：

普通的摄像头对于目标的检测只能分辨出目标类别，对于目标在三维空间的位置感知误差较大。激光雷达进行三维目标检测具有天然的距离优势，能够直接获取到各个点的位置信息，但其缺乏图像丰富的视觉信息。

不同类型的传感器各有优劣，单一传感器无法实现精确高效的检测.为此，将具有互补特性的多种传感器融合以增强感知能力，图像和点云融合的三维目标检测方法既能弥补图像的深度不足也能弥补点云缺乏视觉信息的不足。

目前的路径规划算法分为两大类，以A*算法为代表的全局路径规划的算法，和以人工势场法为例的局部避障算法。两种算法各有优劣，A*算法可以求得全局最优解从而避免无人机陷入局部最优解，但是A*算法需要提前获知整个地图的信息且算法随着地图的增大解算时间也会延长；而人工势场法可以快速针对障碍物位置信息做出响应，方法可靠性高，不依赖环境的先验信息和障碍物形状，不受障碍物的外形影响，但是会陷入局部最优；具体来说，人工势场法的基本原理，在飞行过程中生成虚拟的两个势力场：引力场、斥力场。然后，在两个势力场联合的作用下，根据各个势力场的模型不同产生不同的作用力，飞行汽车在这些力的作用下进行安全起飞、着陆。

发明内容

本发明的目的在于克服现有技术缺陷，提出了一种基于三维目标检测的飞行汽车起飞着陆决策规划方法。

为了实现上述目的，本发明提出了一种基于三维目标检测的飞行汽车起飞着陆决策规划方法，基于部署在飞行汽车上的摄像头和激光雷达实现，所述方法包括：

步骤1)根据实时采集的图像和三维点云数据对指定道路进行环境感知，建立动态三维地图；

步骤2)当待决策规划的飞行汽车为飞行状态，转至步骤3)；当待决策规划的飞行汽车为行驶状态，转至步骤5)；

步骤3)根据动态三维地图，结合飞行汽车数据和行驶在单行路的汽车情况，建立斥力场，选取行驶汽车后某点或地面上某点建立引力场；

步骤4)由斥力场和引力场形成实时变化的合力场，驱动飞行汽车进行动态着陆，判断飞行汽车和目标位置间的距离是否满足安全距离，判断为是，控制飞行汽车着陆，并转至步骤7)；判断为否，控制飞行汽车上升，并转至步骤3)重新建立引力场；

步骤5)根据动态三维地图，结合飞行汽车数据和行驶在单行路的汽车情况，建立斥力场，选取空中安全位置建立引力场；