CN109631921B - 用于识别无人驾驶汽车导航路径的中心的方法和设备 - Google Patents
用于识别无人驾驶汽车导航路径的中心的方法和设备 Download PDFInfo
- Publication number
- CN109631921B CN109631921B CN201810189883.3A CN201810189883A CN109631921B CN 109631921 B CN109631921 B CN 109631921B CN 201810189883 A CN201810189883 A CN 201810189883A CN 109631921 B CN109631921 B CN 109631921B
- Authority
- CN
- China
- Prior art keywords
- point
- points
- path
- intermediate points
- obstacle
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 230000003068 static effect Effects 0.000 claims description 26
- 230000007246 mechanism Effects 0.000 claims description 9
- 230000004044 response Effects 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 13
- 238000004891 communication Methods 0.000 description 8
- 230000008859 change Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000008707 rearrangement Effects 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 230000001413 cellular effect Effects 0.000 description 2
- 238000000605 extraction Methods 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- FMFKNGWZEQOWNK-UHFFFAOYSA-N 1-butoxypropan-2-yl 2-(2,4,5-trichlorophenoxy)propanoate Chemical compound CCCCOCC(C)OC(=O)C(C)OC1=CC(Cl)=C(Cl)C=C1Cl FMFKNGWZEQOWNK-UHFFFAOYSA-N 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000003466 anti-cipated effect Effects 0.000 description 1
- 238000003491 array Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 239000000835 fiber Substances 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 239000010931 gold Substances 0.000 description 1
- 229910052737 gold Inorganic materials 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 230000036961 partial effect Effects 0.000 description 1
- 230000002829 reductive effect Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
Images
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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- 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/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- 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/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/161—Decentralised systems, e.g. inter-vehicle communication
- G08G1/163—Decentralised systems, e.g. inter-vehicle communication involving continuous checking
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/165—Anti-collision systems for passive traffic, e.g. including static obstacles, trees
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Business, Economics & Management (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Game Theory and Decision Science (AREA)
- Medical Informatics (AREA)
- Navigation (AREA)
Abstract
本发明提供一种用于识别无人驾驶汽车导航路径的中心的方法和设备。所述方法包括接收连接目的地点和无人驾驶汽车位置点的路径的导航地图。所述方法还包括基于导航地图识别沿路径的边界的多个障碍点。所述方法包括基于多个障碍点确定路径上的多个中间点。中间点位于连接两个连续识别出的障碍点的直线上。所述方法还包括丢弃多个中间点中的至少一个中间点以提取路径上的中间点的最终集合。所述方法包括从目的地点开始到无人驾驶汽车位置点按顺序排列最终集合中的中间点。
Description
技术领域
本发明总体涉及无人驾驶汽车,特别涉及用于识别无人驾驶汽车导航路径的中心的方法和设备。
背景技术
无人驾驶汽车(无人车或自动驾驶汽车)是能够在没有人力输入的情况下感测外部环境和导航的车辆。无人驾驶汽车使用各种技术来检测外部环境或周围事物。这些技术的例子可以包括但不限于雷达、激光、全球定位***(GPS)、里程计以及计算机视觉。为了实现无人驾驶汽车的平稳导航,无人驾驶汽车的控制应当足够稳健以使其能够在不碰撞路径边界的情况下进行导航。
传统***提供了一种通过监测车辆传感器信息以及经由后方检测装置检测到的车辆后方的道路信息来将车辆保持在道路上所期望的位置的方法。所期望的车辆位置信息与预测的未来车辆位置信息进行比较。基于预测的未来位置信息与所期望的车辆位置信息的偏差,生成转向命令。另一种传统***公开了车辆的车道保持***,其中通过设置驾驶员可以驾驶车辆的安全区域来实现还***。车道保持***基于某些参数确定车辆的目标路径。
然而,传统***具有各种缺点。其中一个缺点是:为车辆导航绘制了一条最短的路径,但是这条路径可能不通过道路的中心。而且,道路的某些路段的最短路径可能与道路的边界非常接近。这可能会影响无人驾驶汽车的安全性。
发明内容
在一个实施例中,公开了一种用于识别无人驾驶汽车导航路径的中心的方法。所述方法包括通过导航设备接收连接目的地点和无人驾驶汽车位置点的路径的导航地图。所述方法还包括通过导航设备基于导航地图识别沿路径的边界的多个障碍点。所述方法包括通过导航设备基于多个障碍点确定路径上的多个中间点(halfway point)。中间点位于连接两个连续识别出的障碍点的直线上。所述方法还包括通过导航设备丢弃多个中间点中的至少一个中间点以提取路径上的中间点的最终集合。所述方法包括通过导航设备从目的地点开始到无人驾驶汽车位置点按顺序排列最终集合中的中间点。
在另一实施例中,公开了一种用于识别无人驾驶汽车导航路径的中心的导航设备。导航设备包括处理器和以可通信方式耦合到处理器并且具有存储在其上的处理器指令的存储器,执行处理器指令时使得处理器接收连接目的地点和无人驾驶汽车位置点的路径的导航地图。处理器指令还使得处理器基于导航地图识别沿路径的边界的多个障碍点。处理器指令使得处理器基于多个障碍点确定路径上的多个中间点。中间点位于连接两个连续识别出的障碍点的直线上。处理器指令还使得处理器丢弃多个中间点中的至少一个中间点以提取路径上的中间点的最终集合。处理器指令使得处理器从目的地点开始到无人驾驶汽车位置点按顺序排列最终集合中的中间点。
在又一个实施例中,公开了一种非暂时性计算机可读存储介质。所述非暂时性计算机可读存储介质上存储有指令,所述指令使得包括一个或多个处理器的导航设备执行包括接收连接目的地点和无人驾驶汽车位置点的路径的导航地图的步骤。所述步骤还包括基于导航地图识别沿路径的边界的多个障碍点。所述步骤还包括基于多个障碍点确定路径上的多个中间点。中间点位于连接两个连续识别出的障碍点的直线上。所述步骤还包括丢弃多个中间点中的至少一个中间点以提取路径上的中间点的最终集合。所述步骤还包括从目的地点开始到无人驾驶汽车位置点按顺序排列最终集合中的中间点。
应当理解的是,前面的一般性描述和下面的详细描述仅仅是示例性和解释性的,并不限制所要求保护的本发明。
附图说明
并入本发明并构成本发明的一部分的附图示出了示例性实施例,并且与说明书一起用于解释所公开的原理。
图1示出了可以实施各种实施例的环境。
图2示出了根据一个实施例的导航设备内的各种组件的框图。
图3示出了根据一个实施例的用于识别无人驾驶汽车导航路径的中心的方法的流程图。
图4示出了根据一个实施例的基于导航地图识别沿着路径的边界的障碍点的方法的流程图。
图5示出了根据一个实施例的使用表示导航地图的像素地图来识别沿着路径的边界的障碍点的机制。
图6示出了根据一个实施例的基于彼此的接近度来丢弃多个中间点中的一个或多个的方法的流程图。
图7示出了根据另一实施例的基于与路径边界之一的接近度来丢弃多个中间点中的一个或多个的方法的流程图。
图8示出了根据一个示例性实施例的多个中间点的识别以及随后丢弃多个中间点中的一个或多个。
图9示出了根据一个实施例的用于按顺序排列最终集合中的中间点的方法的流程图。
图10示出了根据一个示例性实施例的从目的地点开始到无人驾驶汽车位置点按顺序排列中间点。
图11示出了用于实现各种实施例的示例性计算机***的框图。
具体实施方式
参考附图描述示例性实施例。在任何方便的地方,全部附图中使用相同的附图标记来表示相同或相似的部分。尽管在此描述了公开的原理的示例和特征,但是在不脱离所公开的实施例的精神和范围的情况下可以进行修正、改编和其他实施。下面的详细描述仅被认为是示例性的,真正的范围和精神由权利要求指示。
以下列出了其他说明性实施例。在一个实施例中,图1示出了可以实施各种实施例的示例性环境100。环境100包括正在路径104上穿行的车辆102。车辆102可以是无人驾驶的、自动的或半自动的车辆,并且车辆102的示例可以包括但不限于汽车、公共汽车、卡车、面包车或双轮车。路径104可以是铺砌的道路、未铺砌的道路或崎岖不平的路线。从图1中显而易见,路径104的边界并非完美的线性,而是不一致的。另外,路径104的边界106a和边界106b之间的沿着路径104从一点到另一点的距离具有显著的变化。结果,自动驾驶汽车102不能精确地确定路径104上的可导航部分。当物理障碍物(自然的或人造的)标记边界106a或106b时,可能导致车辆102碰撞到边界106a或106b中的一个。或者,在没有这种物理障碍的情况下,车辆102可能脱离路径104。图2示出的导航设备200通过识别沿着路径104长度方向直到目的地点的中间点来防止车辆102的这种事故和由其引发的故障。此后,车辆102沿着这些中间点进行导航以到达目的地点。将结合图2做进一步详细解释。
现在参考图2,图2是示出根据一个实施例的导航设备200内的各种组件的框图。导航设备200可以被实现为各种便携式计算设备,诸如智能电话、专用手持设备、平板电脑或平板手机。可选地,导航设备200可以被实现为分布式***,使得导航设备200的少许部件位于便携式设备中,而其他部件可以位于可远程布置或位于车辆内的服务器中。
导航设备200包括处理器202和通信耦合到处理器202的存储器204。存储器204具有存储在其上的处理器指令,其在执行时使处理器202识别无人驾驶汽车导航路径的中心。存储器204包括存储在其上的指令,其在执行时使处理器202生成无失真图像。存储器204可以是非易失性存储器或易失性存储器。非易失性存储器的示例可以包括但不限于闪存、只读存储器(ROM)、可编程ROM(PROM)、可擦除可编程只读存储器(EPROM)以及带电可擦可编程只读存储器(EEPROM)。易失性存储器的示例可以包括但不限于动态随机存取存储器(DRAM)和静态随机存取存储器(SRAM)。
导航设备200可以进一步包括通信耦合到处理器202的传感器206。传感器206的示例可以包括但不限于光探测和测距(LIDAR)、全球定位***(GPS)、激光、里程计以及计算机视觉。在一个实施例中,传感器206可以位于无人驾驶汽车内部,但位于导航设备200外部。在这种情况下,传感器206捕获与无人驾驶汽车周围的外部条件和环境相关的信息,并与导航设备200共享以用于进一步分析。
为了识别路径的中心,存储器204包括车辆初始定位模块208、中间点收集模块210、距离估计模块212、重新排列模块214以及路径生成模块216。
车辆初始定位模块208接收连接目的地点和无人驾驶汽车位置点的路径的导航地图。导航地图可以是LIDAR静态地图,所述静态地图包括来自无人驾驶汽车周围的障碍物反射的点云数据。换句话说,点云捕捉无人驾驶汽车周围的360度视图。基于导航地图,车辆初始定位模块208初始化其上的无人驾驶汽车的位置。将结合图3做进一步详细解释。
从无人驾驶汽车的初始化位置开始,中间点收集模块210沿着路径的边界识别多个障碍点。中间点收集模块210还基于多个障碍点确定路径上的多个中间点。中间点位于连接两个连续的所识别的障碍点的直线之间。将结合图3、图4、图5以及图8做进一步详细解释。
之后,距离估计模块212确定每个新的中间点与先前所识别的中间点的距离。距离估计模块212然后执行检查以确定该距离是否小于预先定义距离阈值。另外,距离估计模块212确定每个中间点与路径的边界的距离。距离估计模块212然后执行检查以确定该距离是否小于预先定义接近度阈值。距离估计模块212与重新排列模块214共享每个中间点的距离和预定义阈值的比较结果,重新排列模块214丢弃多个中间点中的一个或多个以提取中间点的最终集合。因此,基于与其他中间点的接近度或者与路径的边界中的一个边界的接近度而丢弃所述多个中间点中的一个或多个中的每一个。将结合图6、图7以及图8做进一步详细解释。重新排列模块214还从目的地点开始到无人驾驶汽车位置点按顺序排列最终集合中的中间点。将结合图9和图10做进一步详细解释。
一旦最终集合中的中间点已经按顺序排列,路径生成模块216通过对这些中间点应用曲线拟合机制以生成用于无人驾驶汽车从无人驾驶汽车位置点到目的地点的穿过或导航的最终路径。将结合图3做进一步详细解释。
现在参考图3,图3示出了根据一个实施例的用于识别无人驾驶汽车导航路径的中心的方法的流程图。在步骤302,导航设备200接收连接目的地点和无人驾驶汽车位置点的路径的导航地图。无人驾驶汽车位置点可以是无人驾驶汽车的当前位置,并且随着无人驾驶汽车继续沿路径移动可继续改变。导航地图可以是LIDAR静态地图,所述静态地图包括来自无人驾驶汽车周围的障碍物反射的点云数据(point cloud data)。换句话说,点云捕捉无人驾驶汽车周围的360度视图。LIDAR静态地图还初始化无人驾驶汽车的位置。
在步骤304,基于导航地图,导航设备200识别沿着路径的边界的多个障碍点。可以使用与导航地图相关联的像素地图来识别多个障碍点。可以通过在预定义方向(例如,水平方向)扫描像素地图来识别给定障碍点。为了识别沿着一条边界的连续的障碍点,可以改变扫描的方向,使得在与预定义方向垂直的方向,即垂直方向上扫描像素地图。因此,每当扫描线接触路径的任一边界时,识别障碍点。在扫描线接触其中一条边界之后,扫描线的方向改变90度,并且当扫描线接触路径的相同或其他边界时识别连续的障碍点。换句话说,在路径的相同或交替的边界上识别两个连续的障碍点。对于本领域技术人员将容易理解的是,执行从无人驾驶位置点开始以及从第一次迭代之后可用的随后识别的中间点到目的地点的多次迭代以识别多个障碍点。将结合图4做进一步详细解释。
基于多个障碍点,导航设备200在步骤306处确定路径上的多个中间点。中间点位于连接两个连续识别的障碍点的直线之间。由于在路径的交替边界上确定了两个连续识别的障碍点,因此中间点可以大致位于边界上的至少两个障碍点之间的中间位置。将结合图8做进一步详细解释。
一旦识别了多个中间点,导航设备200丢弃多个中间点的一个或多个以提取路径上的中间点的最终集合。中间点可能因为它与先前识别的中间点非常接近而被丢弃。将结合图6做进一步详细解释。另外,中间点也可能因为其接近路径的边界之一而被丢弃。将结合图7做进一步详细解释。丢弃一个或多个中间点确保识别出最佳个数量的精确中间点并且此后用于绘制出无人驾驶汽车的导航路径。
在步骤310,导航设备200从目的地点开始到无人驾驶汽车位置点按顺序排列最终集合中的中间点。为此,最终集合中的每个中间点首先绘制在与导航地图尺寸相匹配的静态图上。分析静态图形以按顺序排列中间点。将结合图9和图10做进一步详细解释。在最终集合中的中间点按顺序排列之后,导航设备200在步骤312对这些中间点应用曲线拟合机制。之后,在步骤314,导航设备200生成用于无人驾驶汽车从无人驾驶汽车位置点到目的地点的遍历或导航的最终路径。
现在参考图4,图4示出了根据一个实施例的基于导航地图用于识别沿路径的边界的障碍点的方法流程图。一旦导航设备200接收到导航地图,则创建与导航地图相关联的像素地图以识别障碍点。在步骤402,从无人驾驶汽车位置点(即无人驾驶汽车的当前位置)开始在预定义方向上扫描像素地图。基于无人驾驶汽车的方位和位置,可以在水平方向上开始扫描。第一扫描操作可以朝路径的边界中的一条边界发起,并且同时向路径的另一条边界发起第二扫描操作。因此,预定义方向可以是朝向开始的路径的两个边界的水平方向。在一个实施例中,像素地图可以被分段扫描,使得在给定的时间仅扫描像素地图的一部分,所述部分包括九个像素。将在图5的示例性实施例中做进一步详细解释。
响应于扫描,在步骤404处,在像素地图中具有预定义权重的像素被识别为路径的一条边界上的障碍点。预定义权重,例如,可以与像素的特定颜色相关联。在一个实施例中,不同的权重可以被分配给不同的色调,并且基于路径的地形和与路径相关的现有的环境或其他外部条件,特定的权重可以被选择用来识别为障碍点。在一个实施例中,在路径的边界上将被识别为障碍点的像素的颜色与相邻像素相比可以是较暗的色调。将在图5的示例性实施例中做进一步详细解释。
一旦识别到障碍点,就在步骤406中在与预定义方向垂直的方向上扫描像素地图。由于在水平方向上扫描时识别出障碍点,因此在垂直方向上执行像素地图的连续扫描。对于本领域技术人员来说容易理解的是,可以同时执行多个这样的扫描操作,使得在任何给定时间沿着路径的一条边界的长度方向识别多个障碍点。将结合图8的示例性实施例做进一步详细解释。
之后,在步骤408,在像素地图中具有预定义权重的像素被识别为连续的障碍点,使得其与步骤404识别的障碍点是连续的。由于该迭代的第一扫描方向是水平的,并且第二和每个交替(即2、4、6等)扫描方向是垂直的,所以可以在路径的相对边界上识别两个连续的障碍点。
现在参考图5,图5示出了根据一个实施例的用于使用表示导航地图的像素地图来识别沿路径的边界的障碍点的机制。像素地图被分成部分扫描,使得在给定的时间仅扫描像素地图的部分502。像素地图的部分502包括由导航设备200在给定时间扫描的九个像素的网格。基于对部分502的扫描,导航设备200可以将具有预定义权重的像素中的一个识别为路径边界上的障碍点,并相应地改变扫描像素地图的方向或路线。在一个实施例中,当从起始点(其可以是无人驾驶汽车的当前位置、障碍点或先前找到的中间点)开始的虚拟水平或垂直线遇到不同权重的像素时,该点被认为是障碍点。
举例来说,当扫描部分504时,出现在虚线的路线上;当导航设备200遇到具有预定义权重的编号为‘5’的像素时,导航设备200基于先前的扫描方向改变扫描的路线或方向。因此,如果先前的扫描方向是水平的,则后续的扫描方向将是垂直的,反之亦然。以类似的方式,对于部分506、508、510以及512,导航设备200在遇到像素编号为‘5’的像素之后可以改变扫描像素地图的方向或路线,如图5所示。
现在参考图6,图6示出了根据一个实施例的用于基于彼此的接近度来丢弃多个中间点中的一个或多个的方法流程图。路径上的中间点是通过定位连接两个连续识别的障碍点的直线的中心确定的。这在图8的示例性实施例中被描绘。每次确定新的中间点时,在步骤602确定新的中间点与多个先前识别的中间点中的每一个的距离。多个先前识别的中间点可以包括已经确定用于分开执行所有扫描操作的所有中间点,以识别路径边界上的障碍点。在一个实施例中,与新的中间点进行比较的先前识别出的中间点的数量可以被限制为预定义数量。这可以使得能够优化或减少将距离与先前识别出的中间点进行比较所需的计算次数。
在步骤604,执行检查以确定新的中间点与多个先前识别出的中间点中的一个或多个的距离是否小于预定义距离阈值。当新的中间点与多个先前识别出的中间点中的一个或多个的距离小于预定义距离阈值时,在步骤606丢弃新的中间点或与新的中间点进行比较的先前识别出的中间点中的一个。换句话说,当两个中间点非常接近时,这些中间点中的一个被丢弃。在一个实施例中,丢弃两个中间点中比较靠近路径边界之一的一个。
重新参考步骤604,当新的中间点与多个先前识别出的中间点中的每一个的距离大于预定义距离阈值时,在步骤608中将新的中间点加到中间点的最终集合中。此后,确定连续的中间点,并且对于连续的中间点重复上述步骤。在示例性实施例中,使用下面给出的等式1来确定是否应该丢弃中间点:
X1和Y1是新的中间点的坐标,
X2和Y2是先前识别的中间点的坐标,
D是预定义阈值。
当满足上述等式时,评估新的中间点和先前识别的点中的一个,以便确定两个中间点中的哪一个在路径中更加居中。换句话说,两个中间点中的哪一个离路径的边界更远。与路径边界的距离在四个方向上被测量,即北、南、东、西。丢弃两个中间点中更靠近路径的一个或多个边界的一个,并且保留另一个中间点并将其添加到中间点的最终集合中。举例来说,发现新的中间点更靠近路径的边界中的一个,因此被丢弃。
在一个实施例中,可以独立于与一个或多个先前识别出的中间点的距离来测量中间点到道路边界之一的接近度。将结合图7进行详细解释。
现在参考图7,图7示出了根据一个实施例的基于与路径边界之一的接近度来丢弃多个中间点中的一个或多个的方法流程图。在已经确定了多个中间点之后,在步骤702中确定中间点与路径的一个或多个边界的距离。在步骤704,执行检查以确定中间点与路径边界之一的距离是否小于预定义接近度阈值。预定义接近度阈值可以基于历史上确定的距离路径边界的安全驾驶距离来确定。在一个实施例中,当确定处于同一水平线上的两个障碍点之间的中间点时,在两个垂直方向上,即向上和向下,测量与一个或多个边界的距离。类似地,当确定处于同一垂直线上的两个障碍点之间的中间点时,则在两个水平方向,即左侧和右侧,测量中间点与一个或多个边界的距离。
重新参考步骤704,当中间点的距离小于预定义接近度阈值时,在步骤706中从多个中间点丢弃该中间点。然而,当距离大于或等于预定义接近度阈值时,在步骤708中将该中间点加到中间点的最终集合中。对于本领域技术人员容易理解的是,对于多个中间点中的每个中间点重复上述步骤。基于图6和图7所讨论方法的中间点的丢弃将结合图8的示例性实施例进行描述。
现在参考图8,图8示出了根据一个示例性实施例为路径802确定多个中间点以及随后丢弃多个中间点中的一个或多个。无人驾驶汽车804在路径802上穿行,路径802具有两个边界,即边界806a和边界806b。无人驾驶汽804在路径802上进行导航时要到达目的地点830。基于沿边界806a和806b识别出的多个障碍点确定了多个中间点。在由射线808描绘的第一扫描操作期间识别出的障碍点的示例包括障碍点810、障碍点812、障碍点814、障碍点816以及障碍点818。在水平方向上扫描时识别障碍点816,而在垂直方向上扫描时识别连续的障碍点818。如图8中所描述的,中间点被识别为连接这些连续障碍点中的每一个的直线的中心。
在第一扫描操作的同时,还执行由射线820表示的第二扫描操作以识别障碍点。以类似于上面讨论的方式,通过射线820在边界806a和806b上识别障碍点。再次参考图6,当确定新的中间点时,将新的中间点的距离与每个先前识别出的中间点进行比较。当距离低于预定义距离阈值时,这些中间点中更靠近边界806a和806b之一的一个被丢弃。举例来说,在822和824中,其中要丢弃的中间点用“\”标记。
再次参考图7,每个中间点与边界806a和806b的距离也被确定,并与预定义接近度阈值进行比较。丢弃那些距离小于预定义接近度阈值的中间点。在826和828中描述了其中的两个中间点。类似地,如图6和图7所示,丢弃满足丢弃中间点标准的其他中间点以获得用于进一步分析的中间点的最终集合。
现在参考图9,图9示出了根据一个实施例的用于按顺序排列最终集合中的中间点的方法流程图。一旦获得中间点的最终集合,在步骤902,将最终集合中的每个中间点连同目的地点和无人驾驶汽车位置点一起绘制在静态图上。静态图与导航地图的尺寸相匹配,确保包含所绘制的中间点的静态图可以精确地叠加在导航地图上。之后,在步骤904,执行模式搜索以从目的地点开始扫描静态图上的每个像素。模式搜索可以是框式搜索(boxsearch)或圆形(circle search)搜索之一。
基于模式搜索的执行,在步骤906,按顺序识别最终集合中的中间点。当模式搜索的框式或圆形扫描线触及并穿过中间点时,识别一个中间点。结合识别,在步骤908,依次提取最终集合中的每个中间点。换句话说,提取的中间点从与静态图关联的容器中移除。容器可以是一维阵列,不按顺序存储与最终集合中的中间点相关联的信息。在提取之后,在步骤910,将每个中间点以识别的顺序存储在一维阵列中。当模式搜索的框式或圆形扫描线触及并穿过无人驾驶汽车位置点时,在步骤912,结束模式搜索。结合图10的示例性实施例进一步详细解释这一点。
现在参考图10,图10示出了根据示例性实施例从目的地点到无人驾驶汽车位置点按顺序排列中间点。最终集合的中间点包括中间点‘P1'、‘P2'、‘P3'、‘P4'、‘P5'、‘P6'以及‘P7'。这些中间点中的每一个连同目的地点‘D’和无人驾驶汽车位置点‘O’被绘制在静态图1002上。关于所绘制的中间点、目的地点‘D’以及无人驾驶汽车位置点‘O’的信息不按顺序存储在一维阵列1004中。之后,执行框式搜索1006,以从目的地点‘D’开始,在静态图1002上扫描每个像素。
框式搜索1006使得能够识别按顺序在静态图1002上绘制的中间点P1至P7。当框式搜索1006向前移动并在静态图1002上识别下一个中间点时,框式搜索的大小增加。当框式搜索1006的扫描线触及并穿过中间点时,从静态图1002中提取中间点并存储在一维阵列1008中。然后将中间点从静态图1002中移除,以使其不出现在连续的框式搜索1006中。首先提取目的地点'D',然后是中间点'P1'、'P2'、'P3'、'P4'、'P5'、'P6'和'P7'以及无人驾驶车辆位置点'O'。因此,绘制在静态图1002上的所有这些点被提取并按照提取顺序存储在图10所示的一维阵列1008中。一旦无人驾驶汽车位置点'O'从静态图1002中被提取并存储在一维阵列1008中,则框式搜索1006结束。之后,通过对存储在一维阵列1008中的中间点应用曲线拟合机制,以生成用于无人驾驶汽车遍历或导航的从无人驾驶汽车位置点'O'到目的地点'D'的最终路径。
现在参考图11,图11示出了用于实现各种实施例的示例性计算机***的框图。计算机***1102可以包括中央处理单元(“CPU”或“处理器”),其包括用于执行程序组件的至少一个数据处理器,程序组件用于执行用户生成的或***生成的请求。用户可以包括人,使用诸如包括在本发明中的设备的人,或者这样的设备本身。处理器1104可以包括诸如集成***(总线)控制器、存储器管理控制单元、浮点单元、图形处理单元、数字信号处理单元等的专用处理单元。处理器1104可以包括微处理器,例如AMD速龙(Athlon)、毒龙(Duron)或皓龙(Opteron)微处理器,ARM应用处理器,嵌入式或安全处理器,IBM PowerPC,Intel Core、安腾(Itanium)、至强(Xeon)、赛扬(Celeron)处理器或其他处理器产品线等。处理器1104可以通过主机、分布式处理器、多核、并行、网格或其他架构实现。一些实施例可以利用诸如专用集成电路(ASIC)、数字信号处理器(DSP)、现场可编程门阵列(FPGA)等的嵌入式技术。
处理器1104可以被设置为经由I/O接口1106与一个或多个输入/输出(I/O)设备通信。I/O接口1106可以采用诸如但不限于音频、模拟、数字、单声道、RCA、立体声、IEEE-1394、串行总线、通用串行总线(USB)、红外、PS/2、BNC、同轴、组件、复合、数字视频接口(DVI)、高清多媒体接口(HDMI)、RF天线、S-Video、VGA、IEEE 802.n/b/g/n/x、蓝牙和蜂窝(例如,码分多址(CDMA)、高速分组接入(HSPA+)、全球移动通信***(GSM)、长期演进(LTE)、WiMax等)等通信协议/方法。
使用I/O接口1106,计算机***1102可以与一个或多个I/O设备进行通信。例如,输入设备1108可以是天线、键盘、鼠标、操纵杆、(红外)遥控器、照相机、读卡器、传真机、软件狗、生物特征读取设备、麦克风、触摸屏、触摸板、轨迹球、传感器(例如,加速计、光传感器、GPS、陀螺仪、接近传感器等)、触控笔、扫描仪、存储设备、收发器、视频设备/视频源、头戴式显示器等。输出设备1110可以是打印机、传真机、视频显示器(例如,阴极射线管(CRT)、液晶显示器(LCD)、发光二极管(LED)、等离子体等)、音频扬声器等。在一些实施例中,收发器1112可以与处理器1104连接。收发器1112可以促进各种类型的无线传输或接收。例如,收发器1112可以包括可操作地连接到收发器芯片(例如,德州仪器(Instruments)WiLink博通公司(例如德州仪器(Texas Instruments)WiLink WL1283、博通(Broadcom)BCM4550IUB8收发器、英飞凌科技(Infineon Technologies)X-Gold 618-PMB9800收发器等)的天线,提供IEEE802.11a/b/g/n、蓝牙、FM、全球定位***(GPS)、2G/3GHSDPA/HSUPA通信等。
在一些实施例中,处理器1104可以设置为经由网络接口1116与通信网络1114通信。网络接口1116可以与通信网络1114通信。网络接口1116可以采用连接协议,包括但不限于直接连接、以太网(例如,双绞线50/500/5000Base T)、传输控制协议/网际协议(TCP/IP)、令牌环、IEEE 802.11a/b/g/n/x等。通信网络1114可以包括但不限于直接互连、局域网(LAN)、广域网(WAN)、无线网络(例如使用无线应用协议)、因特网等。使用网络接口1116和通信网络1114,计算机***1102可以与设备1118、1120以及1122进行通信。这些设备可以包括但不限于个人计算机、服务器、传真机、打印机、扫描仪、各种移动设备(诸如蜂窝电话)、智能电话(例如苹果智能手机、黑莓智能手机、安卓手机等)、平板电脑、电子书阅读器(亚马逊电子书阅读器、平板电脑等)、手提电脑、笔记本电脑、游戏机(微软游戏机、任天堂游戏机、索尼游戏机等)等。在一些实施例中,计算机***1102本身可包含这些设备中的一个或多个。
在一些实施例中,处理器1104可以被设置为经由存储接口1124与一个或多个存储器设备(例如,RAM 1126、ROM 1128等)进行通信。所述存储接口可采用诸如串行高级技术连接(SATA)、集成驱动电子设备(IDE)、IEEE-1394、通用串行总线(USB)、光纤通道、小型计算机***接口(SCSI)等的连接协议,存储接口1124可以连接到包括但不限于存储器驱动器、可移动磁盘驱动器等的存储器1130。存储器驱动器还可以包括磁鼓、磁盘驱动器、磁光驱动器、光盘驱动器、独立磁盘冗余阵列(RAID)、固态存储设备、固态驱动器等。
存储器1130可以存储程序或数据库组件的集合,包括但不限于操作***1132、用户接口应用1134、网页浏览器1136、邮件服务器1138、邮件客户端1140、用户/应用数据1142(例如,本发明中讨论的任何数据变量或数据记录)等。操作***1132可以促进计算机***1102的资源管理和操作。操作***1132的示例包括但不限于苹果Mac OS X平台、UNIX平台、类Unix***套件((例如,伯克利软件套件(BSD)、FreeBSD、NetBSD、OpenBSD等)、LINUX套件(例如,等)、OS/2平台、微软平台(XP、Vista/7/8等)、苹果平台、谷歌安卓平台、黑莓OS平台等。用户界面1134可以通过文本或图形设施来促进程序组件的显示、执行、交互、操纵或操作。例如,用户界面可以在可操作地连接到计算机***1102的显示***上提供诸如光标、图标、复选框、菜单、滚动器、窗口、小部件等的计算机交互界面元素。可以采用图形用户界面(GUI),包括但不限于苹果操作***的平台、平台、微软平台(例如,平台、平台等)、UNIX X-WINDOWS、网页界面库(例如平台、编程语言、编程语言、编程语言、HTML平台等)等。
在一些实施例中,计算机***1102可以实现网页浏览器1136存储的程序组件。网页浏览器1136可以是超文本浏览应用程序,诸如微软IE浏览器、谷歌浏览器、网页浏览器、苹果网页浏览器等。可以使用HTTPS(安全超文本传输协议)、安全套接字层(SSL)、传输层安全性(TLS)等提供安全的网页浏览。网页浏览器可以利用诸如AJAX、DHTML、平台、编程语言、编程语言、应用程序编程接口(APIs)等工具。在一些实施例中,计算机***1102可以实现邮件服务器1138存储的程序组件。邮件服务器1138可以是诸如微软邮件服务器的因特网邮件服务器。邮件服务器1138可以利用诸如ASP、ActiveX、ANSI C++/C#、微软编程语言、CGI脚本、编程语言、编程语言、编程语言、编程语言、编程语言、网页对象等工具。邮件服务器1138可以利用诸如因特网消息访问协议(IMAP)、消息应用程序编程接口(MAPI)、微软Exchange、邮局协议(POP)、简单邮件传输协议(SMTP)等通信协议。在一些实施例中,计算机***1102可以实现邮件客户端1140存储的程序组件。邮件客户端1140可以是邮件查看应用程序,诸如苹果邮件客户端、微软邮件客户端、微软邮件客户端、Mozilla邮件客户端等。
在一些实施例中,计算机***1102可以存储用户/应用数据1142,如本发明中所描述的数据、变量、记录等。这样的数据库可以实现为容错、关系、可扩展、安全的数据库,如数据库或数据库。可替代地,这样的数据库可以使用诸如数组、散列、链表、结构、结构化文本文件(例如XML)、表格的标准化数据结构实现,或者作为面向对象的数据库(例如,使用对象数据库、对象数据库、对象数据库等)。这样的数据库可以被合并或分布,有时在本发明中上面讨论的各种计算机***中。应该理解的是,任何计算机或数据库部件的结构和操作可以按照任意的有效组合形式进行组合、合并或分配。
应该认识到,为了清楚,上面的描述已经参考不同的功能单元和处理器描述了本发明的实施例。然而,将容易理解的是,可以在不偏离本发明的前提下可以在不同的功能元件、处理器或域之间对功能进行任何适当分配。例如,说明为由不同的处理器或控制器执行的功能可以由相同的处理器或控制器执行。因此,对特定功能单元的引用仅被视为对用于提供所描述的功能的合适手段的引用,而不是指示严格的逻辑或物理结构或组织。
本发明的各种实施例提供了用于识别无人驾驶汽车导航路径的中心的方法和设备。所述设备和方法使得能够精确地检测路径的中心,从而避免无人驾驶汽车在穿行路径时与边界发生碰撞。在所述方法中,检测多个中间点,并且随后基于彼此或与路径的边界的接近度而丢弃一个或多个中间点。从而使得路径中心的检测精度显著提高。
说明书描述了用于识别无人驾驶汽车导航路径的中心的方法和设备。阐述所示步骤以解释所示的示例性实施例,并且应当预料到,正在进行的技术发展将改变执行特定功能的方式。本文给出的示例是为了说明而不是限制。此外,为了便于描述,功能构建块的边界在此被任意地定义。只要规定的功能及其关系适当地执行,就可以定义可选的边界。基于本文所包含的教导,对于相关领域的技术人员来说,替代方案(包括本文所述的那些的同等物、扩展、变化、偏差等)将是容易理解的。这些替代方案落入所公开实施例的范围和精神内。
此外,一个或多个计算机可读存储介质可以用于实现与本发明一致的实施例。计算机可读存储介质是指可以存储处理器可读的信息或数据的任何类型的物理存储器。因此,计算机可读存储介质可以存储用于由一个或多个处理器执行的指令,包括用于使处理器执行与本文描述的实施例一致的步骤或阶段的指令。术语“计算机可读介质”应理解为包括有形物品,并排除载波和瞬态信号,即是非瞬态的。示例包括随机存取存储器(RAM)、只读存储器(ROM)、易失性存储器、非易失性存储器、硬盘驱动器、CD ROMs、DVD、闪存驱动器、磁盘以及任何其他已知的物理存储介质。
所述公开和示例旨在被认为仅是示例性的,所公开的实施例的真实范围和精神由权利要求示出。
Claims (19)
1.一种用于识别无人驾驶汽车导航路径的中心的方法,其特征在于,所述方法包括:
通过导航设备接收连接目的地点和无人驾驶汽车位置点的路径的导航地图;
通过所述导航设备基于所述导航地图识别沿所述路径的边界的多个障碍点;
通过所述导航设备基于所述多个障碍点确定所述路径上的多个中间点,其中,中间点位于连接两个连续识别出的障碍点的直线上;
通过所述导航设备丢弃所述多个中间点中的至少一个中间点以提取所述路径上的中间点的最终集合;以及
从所述目的地点开始到所述无人驾驶汽车位置点按顺序排列所述最终集合中的中间点,
其中,识别所述多个障碍点包括:
在预定义方向上扫描与所述导航地图相关联的像素地图;以及
响应于在所述预定义方向上的所述扫描,将所述像素地图中包括预定义权重的像素识别为所述障碍点。
2.根据权利要求1所述的方法,其特征在于,还包括:
对按所述顺序排列的所述最终集合中的所述中间点应用曲线拟合机制;以及
响应于所述曲线拟合机制,生成用于供所述无人驾驶汽车穿过的从所述目的地点到所述无人驾驶汽车位置点的最终路径。
3.根据权利要求1所述的方法,其特征在于,所述导航地图是光探测和测距静态地图,所述静态地图包括来自所述无人驾驶汽车周围的障碍物反射的点云数据。
4.根据权利要求1所述的方法,其特征在于,所述预定义权重与所述像素的颜色相关联。
5.根据权利要求1所述的方法,其特征在于,还包括:
响应于识别出一个障碍点,在与所述预定义方向垂直的方向上扫描所述像素地图;以及
响应于在与所述预定义方向垂直的所述方向上扫描所述像素地图,将所述像素地图中包括所述预定义权重的像素识别为与在所述预定义方向上所识别出的所述一个障碍点连续的连续障碍点。
6.根据权利要求1所述的方法,其特征在于,丢弃所述至少一个中间点中的一个包括:
确定新的中间点与多个先前所识别出的中间点中的每一个的距离,其中所述多个中间点包括所述新的中间点和所述多个先前所识别出的中间点;以及
当所述新的中间点与所述多个先前所识别出的中间点中的至少一个的距离小于预定义距离阈值时,丢弃所述新的中间点。
7.根据权利要求1所述的方法,其特征在于,丢弃所述至少一个中间点中的一个包括:
确定所述多个中间点中的一个中间点与所述路径的所述边界中的至少一个的距离;以及
当该中间点的该距离小于预定义接近度阈值时,丢弃所述多个中间点中的该中间点。
8.根据权利要求1所述的方法,其特征在于,按顺序排列所述最终集合中的所述中间点包括将所述最终集合中的每个中间点绘制在静态图上,其中所述静态图与所述导航地图的尺寸相匹配。
9.根据权利要求8所述的方法,其特征在于,还包括:
执行模式搜索以从所述目的地点开始对所述静态图上的每个像素进行扫描,其中所述模式搜索包括框式搜索或圆形搜索中的一个;
基于所述模式搜索的执行,按顺序识别所述最终集合中的中间点,其中当所述模式搜索的扫描线触及并穿过中间点时识别该中间点;以及
当所述模式搜索的扫描线触及并穿过所述无人驾驶汽车位置点时,终止所述模式搜索。
10.根据权利要求9所述的方法,其特征在于,还包括:
响应于中间点的识别,按顺序提取所述最终集合中的每个中间点;以及
按照识别顺序存储在一维阵列中。
11.一种用于识别无人驾驶汽车导航路径的中心的导航设备,其特征在于,所述导航设备包括:
处理器;以及
存储器,所述存储器以可通信方式耦合到所述处理器并且在所述存储器上存储有处理器指令,当执行所述处理器指令时使所述处理器:
接收连接目的地点和无人驾驶汽车位置点的路径的导航地图;
基于所述导航地图识别沿所述路径的边界的多个障碍点;
基于所述多个障碍点确定所述路径上的多个中间点,其中,中间点位于连接两个连续识别出的障碍点的直线上;
丢弃所述多个中间点中的至少一个中间点以提取所述路径上的中间点的最终集合;以及
从所述目的地点开始到所述无人驾驶汽车位置点按顺序排列所述最终集合中的中间点,
其中,为了识别所述多个障碍点,所述处理器指令进一步使所述处理器:
在预定义方向上扫描与所述导航地图相关联的像素地图;以及
响应于在所述预定义方向上的所述扫描,将所述像素地图中包括预定义权重的像素识别为所述障碍点。
12.根据权利要求11所述的导航设备,其特征在于,所述处理器指令还使所述处理器:
对按所述顺序排列的所述最终集合中的所述中间点应用曲线拟合机制;以及
响应于所述曲线拟合机制,生成用于供所述无人驾驶汽车穿过的从所述目的地点到所述无人驾驶汽车位置点的最终路径。
13.根据权利要求11所述的导航设备,其特征在于,所述预定义权重与所述像素的颜色相关联。
14.根据权利要求11所述的导航设备,其特征在于,所述处理器指令还使所述处理器:
响应于识别出一个障碍点,在与所述预定义方向垂直的方向上扫描所述像素地图;以及
响应于在与所述预定义方向垂直的所述方向上扫描所述像素地图,将所述像素地图中包括所述预定义权重的像素识别为与在所述预定义方向上所识别出的所述一个障碍点连续的连续障碍点。
15.根据权利要求11所述的导航设备,其特征在于,为了丢弃所述至少一个中间点中的一个,所述处理器指令进一步使所述处理器:
确定新的中间点与多个先前所识别出的中间点中的每一个的距离,其中所述多个中间点包括所述新的中间点和所述多个先前所识别出的中间点;以及
当所述新的中间点与所述多个先前所识别出的中间点中的至少一个的距离小于预定义距离阈值时,丢弃所述新的中间点。
16.根据权利要求11所述的导航设备,其特征在于,为了丢弃所述至少一个中间点中的一个,所述处理器指令进一步使所述处理器:
确定所述多个中间点中的一个中间点与所述路径的所述边界中的至少一个的距离;以及
当该中间点的该距离小于预定义接近度阈值时,丢弃所述多个中间点中的该中间点。
17.根据权利要求11所述的导航设备,其特征在于,为了按顺序排列所述最终集合中的所述中间点,所述处理器指令进一步使所述处理器将所述最终集合中的每个中间点绘制在静态图上,其中所述静态图与所述导航地图的尺寸相匹配。
18.根据权利要求17所述的导航设备,其特征在于,所述处理器指令还使所述处理器:
执行模式搜索以从所述目的地点开始对所述静态图上的每个像素进行扫描,其中所述模式搜索包括框式搜索或圆形搜索中的一个;
基于所述模式搜索的执行,按顺序识别所述最终集合中的中间点,其中当所述模式搜索的扫描线触及并穿过中间点时识别该中间点;以及
当所述模式搜索的扫描线触及并穿过所述无人驾驶汽车位置点时,终止所述模式搜索。
19.一种非暂时性计算机可读存储介质,其特征在于,所述非暂时性计算机可读存储介质在其上存储有指令,所述指令使得包括一个或多个处理器的导航设备执行以下步骤:
接收连接目的地点和无人驾驶汽车位置点的路径的导航地图;
基于所述导航地图识别沿所述路径的边界的多个障碍点;
基于所述多个障碍点确定所述路径上的多个中间点,其中,中间点位于连接两个连续识别出的障碍点的直线上;
丢弃所述多个中间点中的至少一个中间点以提取所述路径上的中间点的最终集合;以及
从所述目的地点开始到所述无人驾驶汽车位置点按顺序排列所述最终集合中的中间点,
其中,识别所述多个障碍点包括:
在预定义方向上扫描与所述导航地图相关联的像素地图;以及
响应于在所述预定义方向上的所述扫描,将所述像素地图中包括预定义权重的像素识别为所述障碍点。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
IN201741035571 | 2017-10-06 | ||
IN201741035571 | 2017-10-06 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109631921A CN109631921A (zh) | 2019-04-16 |
CN109631921B true CN109631921B (zh) | 2022-07-15 |
Family
ID=65993908
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810189883.3A Active CN109631921B (zh) | 2017-10-06 | 2018-03-08 | 用于识别无人驾驶汽车导航路径的中心的方法和设备 |
Country Status (2)
Country | Link |
---|---|
US (1) | US10788831B2 (zh) |
CN (1) | CN109631921B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11288521B2 (en) | 2019-01-31 | 2022-03-29 | Uatc, Llc | Automated road edge boundary detection |
US20210064031A1 (en) * | 2019-08-28 | 2021-03-04 | Zenuity Ab | Path planning for autonomous and semi-autonomous vehicles |
CN114291084A (zh) * | 2019-10-09 | 2022-04-08 | 北京百度网讯科技有限公司 | 用于控制车辆的方法和装置 |
US11061403B2 (en) * | 2019-12-12 | 2021-07-13 | Baidu Usa Llc | Path planning with a preparation distance for a lane-change |
CN111174793B (zh) * | 2020-01-17 | 2021-11-30 | 北京市商汤科技开发有限公司 | 路径规划方法及装置、存储介质 |
US20230063809A1 (en) * | 2021-08-25 | 2023-03-02 | GM Global Technology Operations LLC | Method for improving road topology through sequence estimation and anchor point detetection |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102785661A (zh) * | 2012-08-20 | 2012-11-21 | 深圳先进技术研究院 | 车道偏离控制***及方法 |
WO2014011990A1 (en) * | 2012-07-13 | 2014-01-16 | International Electronic Machines Corp. | Straight line path planning |
US9098754B1 (en) * | 2014-04-25 | 2015-08-04 | Google Inc. | Methods and systems for object detection using laser point clouds |
CN106842231A (zh) * | 2016-11-08 | 2017-06-13 | 长安大学 | 一种道路边界检测及跟踪方法 |
Family Cites Families (51)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6614917B1 (en) * | 1999-10-22 | 2003-09-02 | Lockheed Martin Corporation | Dynamic process for identifying objects in multi-dimensional data |
JP4543637B2 (ja) * | 2003-08-26 | 2010-09-15 | 三菱電機株式会社 | 地図情報処理装置 |
US7228232B2 (en) * | 2005-01-24 | 2007-06-05 | International Business Machines Corporation | Navigating a UAV with obstacle avoidance algorithms |
US20100004802A1 (en) * | 2005-01-25 | 2010-01-07 | William Kress Bodin | Navigating UAVS with an on-board digital camera |
US7930101B2 (en) * | 2007-01-10 | 2011-04-19 | Tomtom International B.V. | Navigation device and method for enhanced map display |
JP2008309529A (ja) * | 2007-06-12 | 2008-12-25 | Panasonic Corp | ナビゲーション装置、ナビゲーション方法、及びナビゲーション用プログラム |
WO2009003529A1 (en) * | 2007-07-04 | 2009-01-08 | Saab Ab | Arrangement and method for providing a three dimensional map representation of an area |
US8699754B2 (en) * | 2008-04-24 | 2014-04-15 | GM Global Technology Operations LLC | Clear path detection through road modeling |
US8605947B2 (en) * | 2008-04-24 | 2013-12-10 | GM Global Technology Operations LLC | Method for detecting a clear path of travel for a vehicle enhanced by object detection |
US8428305B2 (en) * | 2008-04-24 | 2013-04-23 | GM Global Technology Operations LLC | Method for detecting a clear path through topographical variation analysis |
US8917904B2 (en) * | 2008-04-24 | 2014-12-23 | GM Global Technology Operations LLC | Vehicle clear path detection |
US8332134B2 (en) * | 2008-04-24 | 2012-12-11 | GM Global Technology Operations LLC | Three-dimensional LIDAR-based clear path detection |
US8611585B2 (en) * | 2008-04-24 | 2013-12-17 | GM Global Technology Operations LLC | Clear path detection using patch approach |
US8170739B2 (en) | 2008-06-20 | 2012-05-01 | GM Global Technology Operations LLC | Path generation algorithm for automated lane centering and lane changing control system |
US8521339B2 (en) * | 2008-09-09 | 2013-08-27 | Aeryon Labs Inc. | Method and system for directing unmanned vehicles |
US8660316B2 (en) * | 2010-03-04 | 2014-02-25 | Navteq B.V. | Navigating on images |
US8880341B2 (en) * | 2010-08-30 | 2014-11-04 | Alpine Electronics, Inc. | Method and apparatus for displaying three-dimensional terrain and route guidance |
KR20120071160A (ko) * | 2010-12-22 | 2012-07-02 | 한국전자통신연구원 | 이동체용 실외 지도 제작 방법 및 그 장치 |
US9291460B2 (en) * | 2011-07-22 | 2016-03-22 | Google Inc. | Map processing for indoor navigation guidance |
US8878865B2 (en) * | 2011-09-21 | 2014-11-04 | Hover, Inc. | Three-dimensional map system |
US9072929B1 (en) * | 2011-12-01 | 2015-07-07 | Nebraska Global Investment Company, LLC | Image capture system |
US9404764B2 (en) * | 2011-12-30 | 2016-08-02 | Here Global B.V. | Path side imagery |
US9024970B2 (en) * | 2011-12-30 | 2015-05-05 | Here Global B.V. | Path side image on map overlay |
EP2894600B1 (en) * | 2014-01-14 | 2018-03-14 | HENSOLDT Sensors GmbH | Method of processing 3D sensor data to provide terrain segmentation |
CN104835134B (zh) * | 2014-02-11 | 2018-01-02 | 阿里巴巴集团控股有限公司 | 一种计算商品图像牛皮癣分值的方法和装置 |
US9153132B2 (en) * | 2014-03-04 | 2015-10-06 | Nissan North America, Inc. | On-board vehicle control system and method for determining whether a value is within an area of interest for extraneous warning suppression |
KR101610502B1 (ko) * | 2014-09-02 | 2016-04-07 | 현대자동차주식회사 | 자율주행차량의 주행환경 인식장치 및 방법 |
GB201419883D0 (en) * | 2014-11-07 | 2014-12-24 | F Robotics Acquisitions Ltd | Domestic robotic system and method |
FR3030974B1 (fr) * | 2014-12-19 | 2018-03-23 | Stereolabs | Systeme pour la prise de vue en trois dimensions au cours d'un deplacement |
KR102623680B1 (ko) * | 2015-02-10 | 2024-01-12 | 모빌아이 비젼 테크놀로지스 엘티디. | 자율 주행을 위한 약도 |
KR102614323B1 (ko) * | 2015-04-01 | 2023-12-14 | 바야비전 리미티드 | 수동 및 능동 측정을 이용한 장면의 3차원 지도 생성 |
US10013610B2 (en) * | 2015-10-23 | 2018-07-03 | Nokia Technologies Oy | Integration of positional data and overhead images for lane identification |
US9933513B2 (en) * | 2016-02-18 | 2018-04-03 | Aeye, Inc. | Method and apparatus for an adaptive ladar receiver |
EP3430427B1 (en) * | 2016-03-14 | 2021-07-21 | IMRA Europe S.A.S. | Processing method of a 3d point cloud |
US9864377B2 (en) * | 2016-04-01 | 2018-01-09 | Locus Robotics Corporation | Navigation using planned robot travel paths |
EP3236212B1 (en) * | 2016-04-22 | 2023-01-25 | Volvo Car Corporation | Method for generating navigation data and a navigation device for performing the method |
US10395117B1 (en) * | 2016-08-29 | 2019-08-27 | Trifo, Inc. | Visual-inertial positional awareness for autonomous and non-autonomous tracking |
US10168709B2 (en) * | 2016-09-14 | 2019-01-01 | Irobot Corporation | Systems and methods for configurable operation of a robot based on area classification |
US10929730B2 (en) * | 2016-09-28 | 2021-02-23 | 3M Innovative Properties Company | Retroreflective multiscale codes |
US10635913B2 (en) * | 2016-10-17 | 2020-04-28 | Mediatek Inc. | Path planning method and related navigation device |
US10274325B2 (en) * | 2016-11-01 | 2019-04-30 | Brain Corporation | Systems and methods for robotic mapping |
US10293485B2 (en) * | 2017-03-30 | 2019-05-21 | Brain Corporation | Systems and methods for robotic path planning |
US10210411B2 (en) * | 2017-04-24 | 2019-02-19 | Here Global B.V. | Method and apparatus for establishing feature prediction accuracy |
US10210403B2 (en) * | 2017-04-24 | 2019-02-19 | Here Global B.V. | Method and apparatus for pixel based lane prediction |
US10402995B2 (en) * | 2017-07-27 | 2019-09-03 | Here Global B.V. | Method, apparatus, and system for real-time object detection using a cursor recurrent neural network |
US10509413B2 (en) * | 2017-09-07 | 2019-12-17 | GM Global Technology Operations LLC | Ground reference determination for autonomous vehicle operations |
US20190113920A1 (en) * | 2017-10-18 | 2019-04-18 | Luminar Technologies, Inc. | Controlling an autonomous vehicle using model predictive control |
US10591605B2 (en) * | 2017-10-19 | 2020-03-17 | Gerard Dirk Smits | Methods and systems for navigating a vehicle including a novel fiducial marker system |
US10482655B2 (en) * | 2017-11-20 | 2019-11-19 | Here Global B.V. | Method and apparatus for providing a tile-based digital elevation model |
US10671862B2 (en) * | 2018-01-30 | 2020-06-02 | Wipro Limited | Method and system for detecting obstacles by autonomous vehicles in real-time |
US10585436B2 (en) * | 2018-02-15 | 2020-03-10 | Wipro Limited | Method and system for real-time generation of reference navigation path for navigation of vehicle |
-
2017
- 2017-12-13 US US15/840,188 patent/US10788831B2/en active Active
-
2018
- 2018-03-08 CN CN201810189883.3A patent/CN109631921B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014011990A1 (en) * | 2012-07-13 | 2014-01-16 | International Electronic Machines Corp. | Straight line path planning |
CN102785661A (zh) * | 2012-08-20 | 2012-11-21 | 深圳先进技术研究院 | 车道偏离控制***及方法 |
US9098754B1 (en) * | 2014-04-25 | 2015-08-04 | Google Inc. | Methods and systems for object detection using laser point clouds |
CN106842231A (zh) * | 2016-11-08 | 2017-06-13 | 长安大学 | 一种道路边界检测及跟踪方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109631921A (zh) | 2019-04-16 |
US10788831B2 (en) | 2020-09-29 |
US20190107838A1 (en) | 2019-04-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109631921B (zh) | 用于识别无人驾驶汽车导航路径的中心的方法和设备 | |
US10503171B2 (en) | Method and system for determining drivable navigation path for an autonomous vehicle | |
US10612932B2 (en) | Method and system for correcting a pre-generated navigation path for an autonomous vehicle | |
EP3361278B1 (en) | Autonomous vehicle localization based on walsh kernel projection technique | |
US11042762B2 (en) | Sensor calibration method and device, computer device, medium, and vehicle | |
US10684131B2 (en) | Method and system for generating and updating vehicle navigation maps with features of navigation paths | |
US11320836B2 (en) | Algorithm and infrastructure for robust and efficient vehicle localization | |
US10620638B2 (en) | Method, system, and device for guiding autonomous vehicles based on dynamic extraction of road region | |
US10793150B2 (en) | Method and device for controlling vehicle based on neighboring vehicles | |
US10768011B2 (en) | Method and system for positioning an autonomous vehicle on a navigation map | |
EP3527947B1 (en) | Method for generating a safe navigation path for a vehicle and a system thereof | |
US20210300440A1 (en) | Method and system of determining trajectory for an autonomous vehicle | |
US11416004B2 (en) | System and method for validating readings of orientation sensor mounted on autonomous ground vehicle | |
US20200209363A1 (en) | Method and system for testing lidar sensors | |
CN115147809B (zh) | 一种障碍物检测方法、装置、设备以及存储介质 | |
US20210096568A1 (en) | System and method for dynamically adjusting a trajectory of an autonomous vehicle during real-time navigation | |
CN113469045B (zh) | 无人集卡的视觉定位方法、***、电子设备和存储介质 | |
US11417119B2 (en) | Method and system for navigating vehicles based on road conditions determined in real-time | |
CN109388134B (zh) | 用于识别车辆导航路径边界的方法和装置 | |
EP3444793B1 (en) | Method and device for controlling an autonomous vehicle using location information | |
CN113587937A (zh) | 车辆的定位方法、装置、电子设备和存储介质 | |
US11487299B2 (en) | Method and system for localizing autonomous ground vehicles |
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 |