CN110673595B - 车辆自动驾驶时避障的方法、系统及车辆 - Google Patents

Abstract

本发明提供了一种车辆自动驾驶时避障的方法、系统及车辆，该方法包括：提供车辆附近预设范围的道路环境模型；如果当前行驶车道在预设范围内存在多个障碍物，则根据道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、当前行驶车道的宽度以及第一临近障碍物与第二临近障碍物在当前行驶车道行驶方向上的障碍物间距，并获取车辆的车速；根据第一障碍物的位置和尺寸、第二障碍物的位置和尺寸、车辆的车速和障碍物间距判断车辆可以在当前行驶车道内绕过第一临近障碍物和第二临近障碍物通行时，控制车辆不换道避障。本发明的方法可以根据当前行驶道路的障碍物位置和尺寸判断是否可以通行，进而控制车辆。

Description

车辆自动驾驶时避障的方法、系统及车辆

技术领域

本发明涉及车辆自动驾驶技术领域，特别涉及一种车辆自动驾驶时避障的方法、系统及车辆。

背景技术

车辆无人驾驶指通过车载传感系统感知道路环境，自动规划行车路线并控制车辆行驶。当车辆自动驾驶时，如果当前行驶车道存在障碍物，则需要获取障碍物信息，并控制车辆躲避障碍物。因此亟需一种在自动驾驶时可以躲避障碍物的技术。

发明内容

有鉴于此，本发明的第一个目的在于提出一种车辆自动驾驶时避障的方法，该方法可以根据当前车道的障碍物位置和尺寸判断是否可以通行，进而控制车辆行驶。

为达到上述目的，本发明的技术方案是这样实现的：

一种车辆自动驾驶时避障的方法，包括以下步骤：提供车辆附近预设范围的道路环境模型，所述包括所述车辆附近预设范围内的车道位置和车道宽度，以及障碍物的尺寸和位置；如果当前行驶车道在所述预设范围内存在多个障碍物，则根据获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、所述当前行驶车道的宽度以及所述第一临近障碍物与所述第二临近障碍物在所述当前行驶车道行驶方向上的障碍物间距，并获取所述车辆的车速；根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸、所述车辆的车速和所述障碍物间距判断所述车辆是否可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；如果可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行，则控制所述车辆在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；其中，所述第一临近障碍物为所述当前行驶车道的行驶方向上与所述车辆最近的障碍物，所述第二临近障碍物为所述当前行驶车道的行驶方向上所述第一临近障碍物最近的障碍物。

进一步的，所述根据所述第一障碍物的位置和尺寸、所述第二障碍物的位置和尺寸、所述车辆的车速和所述障碍物间距判断所述车辆是否可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行的步骤，具体包括：根据所述第一临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第一临近障碍物处的通行宽度；如果所述第一临近障碍物处的通行宽度小于第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；如果所述第一临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则根据所述第二临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第二临近障碍物处的通行宽度；如果所述第二临近障碍物处的通行宽度小于所述第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；如果所述第二临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则获取经过所述第一临近障碍物的车辆位置和经过所述第二临近障碍物的车辆位置；根据所述经过所述第一临近障碍物的车辆位置、所述经过所述第二临近障碍物的车辆位置、所述车辆的车速和所述障碍物间距判断所述车辆是否可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；如果判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置，则判定所述车辆可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行。

进一步的，所述根据所述经过所述第一临近障碍物的车辆位置、所述经过所述第二临近障碍物的车辆位置、所述车辆的车速和所述障碍物间距判断所述车辆是否可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置的步骤，具体包括：以所述经过所述第一临近障碍物的车辆位置为起点，以经过所述第二临近障碍物的车辆位置为终点，判断所述车辆是否可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点；如果可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；如果不可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆不可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置。

进一步的，在所述提供车辆附近预设范围的道路环境模型的步骤之后，还包括：如果当前行驶车道在所述预设范围内存在多个障碍物，则根据所述道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度；根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度得到综合通行宽度；如果所述综合通行宽度小于第二预设安全行驶宽度，则控制所述车辆在所述第一临近障碍物和所述第二临近障碍物之间直线行驶；其中，当所述第一临近障碍物和所述第二临近障碍物均靠近所述当前行驶车道左右两侧的同一侧时，所述综合通行宽度为所述第一临近障碍物处的通行宽度和所述第一临近障碍物处的通行宽度中的较小值；当所述第一临近障碍物和所述第二临近障碍物靠近所述当前行驶车道左右两侧的不同侧时，所述综合通行宽度为所述第一临近障碍物和所述第二临近障碍物在所述当前行驶车道在左右方向上的最短距离。

进一步的，在所述提供车辆附近预设范围的道路环境模型的步骤之后，还包括：如果所述当前行驶车道在所述预设范围内存在一个障碍物，则获取根据所述道路环境模型所述障碍物的位置和尺寸，并获取所述当前行驶车道的车道宽度；根据所述障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述障碍物处的通行宽度；如果所述障碍物处的通行宽度大于第三预设安全通行宽度，则控制所述车辆在所述当前行驶车道内避开所述障碍物行驶。

相对于现有技术，本发明所述的车辆自动驾驶时避障的方法具有以下优势：

本发明所述的车辆自动驾驶时避障的方法，首先生成车辆附近预设范围的道路环境模型，在道路环境模型上提供所有车道的车道线和当前行驶车道中障碍物的位置尺寸。在当前车道的有效探测范围内存在多个障碍物时，根据与车辆最近的两个障碍物处的通行宽度，以及此两个障碍物之间在车辆行驶方向上的距离和车速判断车辆在当前行驶车道能否避开此两个障碍物通行，进而控制该车辆行驶；在当前行驶车道的有效探测范围内仅存在一个障碍物时，判断该障碍物处的通行宽度是否可以供车辆避开该障碍物，进而控制该车辆行驶。

本发明的另一个目的在于提出一种车辆自动驾驶时避障的系统，该系统可以根据当前行驶道路的障碍物位置和尺寸判断是否可以通行，进而控制车辆行驶。

为达到上述目的，本发明的技术方案是这样实现的：

一种车辆自动驾驶时避障的系统，包括：道路环境模型提供模块，用于提供车辆附近预设范围的道路环境模型，所述道路环境模型包括所述车辆附近预设范围内的车道位置和车道宽度，以及障碍物的尺寸和位置；控制模块，用于根据所述道路环境模型得知在当前行驶车道在所述预设范围内存在多个障碍物时，根据所述道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、所述当前行驶车道的宽度以及所述第一临近障碍物与所述第二临近障碍物在所述当前行驶车道行驶方向上的障碍物间距，并获取所述车辆的车速，进而根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸、所述车辆的车速和所述障碍物间距判断所述车辆是否可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行，并在可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行时，控制所述车辆在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；其中，所述第一临近障碍物为所述当前行驶车道的行驶方向上与所述车辆最近的障碍物，所述第二临近障碍物为所述当前行驶车道的行驶方向上所述第一临近障碍物最近的障碍物。

进一步的，所述控制模块具体用于根据所述第一临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第一临近障碍物处的通行宽度；如果所述第一临近障碍物处的通行宽度小于第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；如果所述第一临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则根据所述第二临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第二临近障碍物处的通行宽度；如果所述第二临近障碍物处的通行宽度小于所述第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；如果所述第二临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则获取经过所述第一临近障碍物的车辆位置和经过所述第二临近障碍物的车辆位置；根据所述经过所述第一临近障碍物的车辆位置、所述经过所述第二临近障碍物的车辆位置、所述车辆的车速和所述障碍物间距判断所述车辆是否可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；如果判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置，则判定所述车辆可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行。

进一步的，所述控制模块还用于以所述经过所述第一临近障碍物的车辆位置为起点，以经过所述第二临近障碍物的车辆位置为终点，判断所述车辆是否可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点；如果可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；如果不可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆不可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置。

进一步的，所述控制模块还用于如果当前行驶车道在所述预设范围内存在多个障碍物，则根据所述道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度；根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度得到综合通行宽度；如果所述综合通行宽度小于第二预设安全行驶宽度，则控制所述车辆在所述第一临近障碍物和所述第二临近障碍物之间直线行驶；其中，当所述第一临近障碍物和所述第二临近障碍物均靠近所述当前行驶车道左右两侧的同一侧时，所述综合通行宽度为所述第一临近障碍物处的通行宽度和所述第一临近障碍物处的通行宽度中的较小值；当所述第一临近障碍物和所述第二临近障碍物靠近所述当前行驶车道左右两侧的不同侧时，所述综合通行宽度为所述第一临近障碍物和所述第二临近障碍物在所述当前行驶车道在左右方向上的最短距离。

所述的车辆自动驾驶时避障的系统与上述的车辆自动驾驶时避障的方法相对于现有技术所具有的优势相同，在此不再赘述。

本发明的又一个目的在于提出一种车辆，该车辆可以根据当前行驶道路的障碍物位置和尺寸判断是否可以通行。

为达到上述目的，本发明的技术方案是这样实现的：

一种车辆，设置有如上述实施例所述的车辆自动驾驶时避障的系统。

所述的车辆与上述的车辆自动驾驶时避障的系统相对于现有技术所具有的优势相同，在此不再赘述。

附图说明

构成本发明的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：

图1为本发明实施例的车辆自动驾驶时避障的方法的流程图；

图2为本发明一个实施例中在当前行驶车道存在距离本车最近的两个障碍物的示意图；

图3为本发明另一实施例中在当前行驶车道存在距离本车最近的两个障碍物的示意图；

图4为本发明又一实施例中在当前行驶车道存在距离本车最近的两个障碍物的示意图；

图5为本发明一个实施例中在当前行驶车道存在一个障碍物的示意图；

图6为本发明实施例的车辆自动驾驶时避障的系统的结构框图。

具体实施方式

需要说明的是，在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互组合。

下面将参考附图并结合实施例来详细说明本发明。

图1为本发明实施例的车辆自动驾驶时避障的方法的流程图。

如图1所示，根据本发明实施例的车辆自动驾驶时避障的方法，包括如下步骤：

S1：提供车辆附近预设范围的道路环境模型，道路环境模型包括车辆附近预设范围内的车道位置和车道宽度，以及障碍物的尺寸和位置。

在本发明的一个实施例中，步骤S1具体包括：获取车辆的位置信息，当前行驶车道内的障碍物的位置和尺寸，以及车辆附近预设范围内的车道位置和车道宽度信息；根据车辆的位置信息，当前行驶车道内的障碍物的位置和尺寸，以及车辆附近预设范围内的车道位置和车道宽度信息生成道路环境模型。

具体地，车辆上设置有环境感知系统，环境感知系统替代驾驶员感官系统通过不同传感器提取道路、车辆位置、障碍物的尺寸和位置等当前行驶环境信息。将上述环境信息进行筛选、关联、追踪、过滤等处理以便获得更为精确的道路信息、物体目标位置、尺寸等信息，最终生成道路环境模型。其中，道路环境模型实时输出车辆前、后方预设范围(例如200米)内车道位置和车道宽度信息，以及在范围内所有车辆、障碍物的尺寸和位置。

S2：如果当前行驶车道在预设范围内存在多个障碍物，则根据道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、当前行驶车道的宽度以及第一临近障碍物与第二临近障碍物在当前行驶车道行驶方向上的障碍物间距，并获取车辆的车速。其中，第一临近障碍物为当前行驶车道的行驶方向上与车辆最近的障碍物，第二临近障碍物为当前行驶车道的行驶方向上第一临近障碍物最近的障碍物。

图2为本发明一个实施例中在当前行驶车道存在距离本车最近的两个障碍物的示意图。如图2所示，在本发明的一个实施例中，第一临近障碍物A与第二临近障碍物B之间的障碍物间距为L1。

S3：根据第一临近障碍物A的位置和尺寸、第二临近障碍物B的位置和尺寸、车辆的车速和障碍物间距L1判断车辆是否可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行。

在本发明的一个实施例中，步骤S3具体包括：

S3-1：根据第一临近障碍物A的位置、尺寸和当前行驶车道的宽度得到第一临近障碍物A处的通行宽度D1。

S3-2：如果第一临近障碍物A处的通行宽度D1小于第一预设安全通行宽度，则判定车辆不可以在当前行驶车道内避开第一临近障碍物A和第二临近障碍物B通行。其中，第一预设安全通行宽度是为了保证车辆可以安全通过障碍物处的道路。示例性地，第一预设安全通行宽度为2.8m(车辆宽度为2m，冗余宽度阈值为0.8m)。

S3-3：如果第一临近障碍物A处的通行宽度D1大于第一预设安全通行宽度，则根据第二临近障碍物B的位置、尺寸和当前行驶车道的宽度得到第二临近障碍物B处的通行宽度D2。

S3-4：如果第二临近障碍物B处的通行宽度D2小于第一预设安全通行宽度，则判定车辆不可以在当前行驶车道内避开第一临近障碍物A和第二临近障碍物B通行。

S3-5：如果第二临近障碍物B处的通行宽度大于第一预设安全通行宽度，则获取经过第一临近障碍物A的车辆位置和经过第二临近障碍物B的车辆位置。

S3-6：根据经过第一临近障碍物A的车辆位置、经过第二临近障碍物B的车辆位置、车辆的车速和障碍物间距L1判断车辆是否可以从经过第一临近障碍物A的车辆位置行驶至经过第二临近障碍物B的车辆位置。

在本发明的一个实施例中，步骤S3-6具体包括：

S3-6-1：以经过第一临近障碍物A的车辆位置为起点，以经过第二临近障碍物B的车辆位置为终点，判断车辆是否可以从起点在障碍物间距下匀速或减速行驶至终点。

具体地，如果第一临近障碍物A和第二临近障碍物B靠近当前行驶道路左右两侧的不同侧(如图2所示)时，在第一临近障碍物A的在行驶方向上的边界点处，以当前车道的可供车辆通行的道路(车道宽度为D1)中间点为起点。在第二临近障碍物B的在行驶方向上的最近点处，以当前车道的可供车辆通行的道路(车道宽度为D2)中间点为终点。

如果第一临近障碍物A和第二临近障碍物B靠近当前行驶道路左右两侧的同一侧时，同样的在第一临近障碍物A的在行驶方向上的边界点处，以当前车道的可供车辆通行的道路(车道宽度为D1)中间点为起点，且在第二临近障碍物B的在行驶方向上的最近点处，以当前车道的可供车辆通行的道路(车道宽度为D2)中间点为终点。

S3-6-2：如果可以从起点在障碍物间距下匀速或减速行驶至终点，则判定车辆可以从经过第一临近障碍物的车辆位置行驶至经过第二临近障碍物的车辆位置。

当第一临近障碍物A和第二临近障碍物B靠近当前行驶道路左右两侧的不同侧(如图2所示)时，此时控制车辆的车速情况时，通过控制车轮转向在障碍物间距L1下判断车辆能否从起点行驶到终点。其次，在控制车辆的减速的情况下，通过控制车轮转向在障碍物间距L1下判断车辆能否从起点行驶到终点。即当车辆的车速不高或障碍物间距L1很大时，车辆可以避开第一临近障碍物A和第二临近障碍物B。

当第一临近障碍物A和第二临近障碍物B靠近当前行驶道路左右两侧的同一侧时，此时只需要保证车辆可以通过第一临近障碍物A和第二临近障碍物B处通行宽度较小的位置即可，而无需考虑障碍物间距L1。

S3-6-3：如果不可以从起点在障碍物间距下匀速或减速行驶至终点，则判定车辆不可以从经过第一临近障碍物的车辆位置行驶至经过第二临近障碍物的车辆位置。

S3-7：如果判断车辆可以从经过第一临近障碍物的车辆位置行驶至经过第二临近障碍物的车辆位置，则判定车辆可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行。

S4：如果可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行，则控制在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行。

在本发明的一个实施例中，在步骤S1之后还包括：

如果当前行驶车道在预设范围内存在多个障碍物，则根据道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和当前行驶车道的宽度。

根据第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和当前行驶车道的宽度得到综合通行宽度。

图3为本发明另一实施例中在当前行驶车道存在距离本车最近的两个障碍物的示意图。如图3所示，当第一临近障碍物A和第二临近障碍物B靠近当前行驶车道左右两侧的不同侧时，综合通行宽度Dz为第一临近障碍物A和第二临近障碍物B在当前行驶车道垂直于行驶方向上的最短距离。当Dz>第二预设安全行驶宽度时，控制车辆在第一临近障碍物A和第二临近障碍物B之间的间隙直线行驶。

图4为本发明又一实施例中在当前行驶车道存在距离本车最近的两个障碍物的示意图。如图4所示，当第一临近障碍物A和第二临近障碍物B均靠近当前行驶车道的同一侧时，综合通行宽度为第一通行宽度D1和第二通行宽度D2之中的宽度较小值，在本示例中综合通行宽度为D1。控制车辆在第一临近障碍物A和第二临近障碍物B之间直线行驶。

如果综合通行宽度大于第二预设安全行驶宽度，则控制车辆在第一临近障碍物和第二临近障碍物之间直线行驶。其中，第二预设安全通行宽度是为了保证车辆可以安全通过障碍物处的道路。示例性地，第二预设安全通行宽度为2.8m(车辆宽度为2m，冗余宽度阈值为0.8m)。

图5为本发明一个实施例中在当前行驶车道存在一个障碍物的示意图。如图5所示，在本发明的一个实施例中，在步骤S1之后，还包括：如果当前行驶车道在预设范围内存在一个障碍物M，则获取障碍物的位置、尺寸和当前行驶车道的车道宽度。根据障碍物M的位置、尺寸和当前行驶车道的车道宽度得到障碍物M处的通行宽度D3；如果D3大于第三预设安全通行宽度，则控制车辆在当前车道内避开障碍物M通行。示例性地，第三预设安全通行宽度为2.8m(车辆宽度为2m，冗余宽度阈值为0.8m)。

本发明的车辆自动驾驶时避障的方法，首先生成车辆附近预设范围的道路环境模型，在道路环境模型上提供所有车道的车道线和当前行驶车道中障碍物的位置尺寸。在当前车道的有效探测范围内存在多个障碍物时，根据与车辆最近的两个障碍物处的通行宽度，以及此两个障碍物之间在车辆行驶方向上的距离和车速判断车辆在当前行驶车道能否避开此两个障碍物通行，进而控制该车辆行驶；在当前行驶车道的有效探测范围内仅存在一个障碍物时，判断该障碍物处的通行宽度是否可以供车辆避开该障碍物，进而控制该车辆行驶。

图6为本发明实施例的车辆自动驾驶时避障的系统的结构框图。如图6所示，本发明实施例的车辆自动驾驶时避障的系统，包括：道路环境模型提供模块610和控制模块620。

其中，道路环境模型提供模块610用于提供车辆附近预设范围的道路环境模型。道路环境模型包括车辆附近预设范围内的车道位置和车道宽度，以及障碍物的尺寸和位置。控制模块620用于根据道路环境模型得知在当前行驶车道在预设范围内存在多个障碍物时，根据道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、当前行驶车道的宽度以及第一临近障碍物与第二临近障碍物在当前行驶车道行驶方向上的障碍物间距，并获取车辆的车速，进而根据第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、车辆的车速和障碍物间距判断车辆是否可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行，并在可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行时，控制车辆在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行。其中，第一临近障碍物为当前行驶车道的行驶方向上与车辆最近的障碍物，第二临近障碍物为当前行驶车道的行驶方向上第一临近障碍物最近的障碍物。

在本发明的一个实施例中，控制模块620具体用于根据第一临近障碍物的位置、尺寸和当前行驶车道的宽度得到第一临近障碍物处的通行宽度；如果第一临近障碍物处的通行宽度小于第一预设安全通行宽度，则判定车辆不可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行；如果第一临近障碍物处的通行宽度大于第一预设安全通行宽度，则根据第二临近障碍物的位置、尺寸和当前行驶车道的宽度得到第二临近障碍物处的通行宽度；如果第二临近障碍物处的通行宽度小于第一预设安全通行宽度，则判定车辆不可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行；如果第二临近障碍物处的通行宽度大于第一预设安全通行宽度，则获取经过第一临近障碍物的车辆位置和经过第二临近障碍物的车辆位置；根据经过第一临近障碍物的车辆位置、经过第二临近障碍物的车辆位置、车辆的车速和障碍物间距判断车辆是否可以从经过第一临近障碍物的车辆位置行驶至经过第二临近障碍物的车辆位置；如果判定车辆可以从经过第一临近障碍物的车辆位置行驶至经过第二临近障碍物的车辆位置，则判定车辆可以在当前行驶车道内避开第一临近障碍物和第二临近障碍物通行。

在本发明的一个实施例中，控制模块620还用于以经过第一临近障碍物的车辆位置为起点，以经过第二临近障碍物的车辆位置为终点，判断车辆是否可以从起点在障碍物间距下匀速或减速行驶至终点；如果可以从起点在障碍物间距下匀速或减速行驶至终点，则判定车辆可以从经过第一临近障碍物的车辆位置行驶至经过第二临近障碍物的车辆位置；如果不可以从起点在障碍物间距下匀速或减速行驶至终点，则判定车辆不可以从经过第一临近障碍物的车辆位置行驶至经过第二临近障碍物的车辆位置。

在本发明的一个实施例中，控制模块620还用于如果当前行驶车道在预设范围内存在多个障碍物，则根据道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和当前行驶车道的宽度；根据第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和当前行驶车道的宽度得到综合通行宽度；如果综合通行宽度大于第二预设安全行驶宽度，则控制车辆在第一临近障碍物和第二临近障碍物之间直线行驶。其中，当第一临近障碍物和第二临近障碍物均靠近当前行驶车道左右两侧的同一侧时，综合通行宽度为第一临近障碍物处的通行宽度和第一临近障碍物处的通行宽度中的较小值；当第一临近障碍物和第二临近障碍物靠近当前行驶车道左右两侧的不同侧时，综合通行宽度为第一临近障碍物和第二临近障碍物在当前行驶车道在左右方向上的最短距离。

本发明的车辆自动驾驶时避障的系统，首先生成车辆附近预设范围的道路环境模型，在道路环境模型上提供所有车道的车道线和当前行驶车道中障碍物的位置尺寸。在当前车道的有效探测范围内存在多个障碍物时，根据与车辆最近的两个障碍物处的通行宽度，以及此两个障碍物之间在车辆行驶方向上的距离和车速判断车辆在当前行驶车道能否避开此两个障碍物通行，进而控制该车辆行驶；在当前行驶车道的有效探测范围内仅存在一个障碍物时，判断该障碍物处的通行宽度是否可以供车辆避开该障碍物，进而控制该车辆行驶。

需要说明的是，本发明实施例的车辆自动驾驶时避障的系统的具体实现方式与本发明实施例的车辆自动驾驶时避障的方法的具体实现方式类似，具体请参见方法部分的描述，为了减少冗余，此处不做赘述。

进一步地，本发明的实施例公开了一种车辆，设置有如上述任意一个实施例中的车辆自动驾驶时避障的生成系统。该车辆可以根据当前行驶道路的障碍物位置和尺寸判断是否可以通行。

另外，根据本发明实施例的车辆的其它构成以及作用对于本领域的普通技术人员而言都是已知的，为了减少冗余，此处不做赘述。

以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (8)

1.一种车辆自动驾驶时避障的方法，其特征在于，包括以下步骤：

提供车辆附近预设范围的道路环境模型，所述道路环境模型包括所述车辆附近预设范围内的车道位置和车道宽度，以及障碍物的尺寸和位置；

如果当前行驶车道在所述预设范围内存在多个障碍物，则根据所述道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、所述当前行驶车道的宽度以及所述第一临近障碍物与所述第二临近障碍物在所述当前行驶车道行驶方向上的障碍物间距，并获取所述车辆的车速；其中，所述第一临近障碍物和所述第二临近障碍物均为静止式障碍物；

根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸、所述车辆的车速和所述障碍物间距判断所述车辆是否可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；

如果可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行，则控制所述车辆在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行，以完成所述车辆的不换道避障；

其中，所述第一临近障碍物为所述当前行驶车道的行驶方向上与所述车辆最近的障碍物，所述第二临近障碍物为所述当前行驶车道的行驶方向上所述第一临近障碍物最近的障碍物，

所述根据所述第一障碍物的位置和尺寸、所述第二障碍物的位置和尺寸、所述车辆的车速和所述障碍物间距判断所述车辆是否可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行的步骤，具体包括：

根据所述第一临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第一临近障碍物处的通行宽度；

如果所述第一临近障碍物处的通行宽度小于第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；

如果所述第一临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则根据所述第二临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第二临近障碍物处的通行宽度；

如果所述第二临近障碍物处的通行宽度小于所述第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；

如果所述第二临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则获取经过所述第一临近障碍物的车辆位置和经过所述第二临近障碍物的车辆位置；

根据所述经过所述第一临近障碍物的车辆位置、所述经过所述第二临近障碍物的车辆位置、所述车辆的车速和所述障碍物间距判断所述车辆是否可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；

如果判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置，则判定所述车辆可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行。

2.根据权利要求1所述的车辆自动驾驶时避障的方法，其特征在于，所述根据所述经过所述第一临近障碍物的车辆位置、所述经过所述第二临近障碍物的车辆位置、所述车辆的车速和所述障碍物间距判断所述车辆是否可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置的步骤，具体包括：

以所述经过所述第一临近障碍物的车辆位置为起点，以经过所述第二临近障碍物的车辆位置为终点，判断所述车辆是否可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点；

如果可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；

如果不可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆不可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置。

3.根据权利要求1所述的车辆自动驾驶时避障的方法，其特征在于，在所述提供车辆附近预设范围的道路环境模型的步骤之后，还包括：

如果当前行驶车道在所述预设范围内存在多个障碍物，则根据所述道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度；

根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度得到综合通行宽度；

如果所述综合通行宽度大于第二预设安全行驶宽度，则控制所述车辆在所述第一临近障碍物和所述第二临近障碍物之间直线行驶；

其中，当所述第一临近障碍物和所述第二临近障碍物均靠近所述当前行驶车道左右两侧的同一侧时，所述综合通行宽度为所述第一临近障碍物处的通行宽度和所述第一临近障碍物处的通行宽度中的较小值；当所述第一临近障碍物和所述第二临近障碍物靠近所述当前行驶车道左右两侧的不同侧时，所述综合通行宽度为所述第一临近障碍物和所述第二临近障碍物在所述当前行驶车道在左右方向上的最短距离。

4.根据权利要求1所述的车辆自动驾驶时避障的方法，其特征在于，在所述提供车辆附近预设范围的道路环境模型的步骤之后，还包括：

如果所述当前行驶车道在所述预设范围内存在一个障碍物，则根据所述道路环境模型获取所述障碍物的位置和尺寸，并获取所述当前行驶车道的车道宽度；

根据所述障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述障碍物处的通行宽度；

如果所述障碍物处的通行宽度大于第三预设安全通行宽度，则控制所述车辆在所述当前行驶车道内避开所述障碍物行驶。

5.一种车辆自动驾驶时避障的系统，其特征在于，包括：

道路环境模型提供模块，用于提供车辆附近预设范围的道路环境模型，所述道路环境模型包括所述车辆附近预设范围内的车道位置和车道宽度，以及障碍物的尺寸和位置；

控制模块，用于根据所述道路环境模型得知在当前行驶车道在所述预设范围内存在多个障碍物时，根据所述道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸、所述当前行驶车道的宽度以及所述第一临近障碍物与所述第二临近障碍物在所述当前行驶车道行驶方向上的障碍物间距，并获取所述车辆的车速，进而根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸、所述车辆的车速和所述障碍物间距判断所述车辆是否可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行，并在可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行时，控制所述车辆在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；

其中，所述第一临近障碍物为所述当前行驶车道的行驶方向上与所述车辆最近的障碍物，所述第二临近障碍物为所述当前行驶车道的行驶方向上所述第一临近障碍物最近的障碍物，

所述控制模块具体用于根据所述第一临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第一临近障碍物处的通行宽度；如果所述第一临近障碍物处的通行宽度小于第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；如果所述第一临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则根据所述第二临近障碍物的位置、尺寸和所述当前行驶车道的宽度得到所述第二临近障碍物处的通行宽度；如果所述第二临近障碍物处的通行宽度小于所述第一预设安全通行宽度，则判定所述车辆不可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行；如果所述第二临近障碍物处的通行宽度大于所述第一预设安全通行宽度，则获取经过所述第一临近障碍物的车辆位置和经过所述第二临近障碍物的车辆位置；根据所述经过所述第一临近障碍物的车辆位置、所述经过所述第二临近障碍物的车辆位置、所述车辆的车速和所述障碍物间距判断所述车辆是否可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；如果判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置，则判定所述车辆可以在所述当前行驶车道内避开所述第一临近障碍物和所述第二临近障碍物通行。

6.根据权利要求5所述的车辆自动驾驶时避障的系统，其特征在于，所述控制模块还用于以所述经过所述第一临近障碍物的车辆位置为起点，以经过所述第二临近障碍物的车辆位置为终点，判断所述车辆是否可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点；如果可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置；如果不可以从所述起点在所述障碍物间距下匀速或减速行驶至所述终点，则判定所述车辆不可以从所述经过所述第一临近障碍物的车辆位置行驶至所述经过所述第二临近障碍物的车辆位置。

7.根据权利要求5所述的车辆自动驾驶时避障的系统，其特征在于，所述控制模块还用于如果当前行驶车道在所述预设范围内存在多个障碍物，则根据所述道路环境模型获取第一临近障碍物的位置和尺寸、第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度；根据所述第一临近障碍物的位置和尺寸、所述第二临近障碍物的位置和尺寸和所述当前行驶车道的宽度得到综合通行宽度；如果所述综合通行宽度大于第二预设安全行驶宽度，则控制所述车辆在所述第一临近障碍物和所述第二临近障碍物之间直线行驶；

其中，当所述第一临近障碍物和所述第二临近障碍物均靠近所述当前行驶车道左右两侧的同一侧时，所述综合通行宽度为所述第一临近障碍物处的通行宽度和所述第一临近障碍物处的通行宽度中的较小值；当所述第一临近障碍物和所述第二临近障碍物靠近所述当前行驶车道左右两侧的不同侧时，所述综合通行宽度为所述第一临近障碍物和所述第二临近障碍物在所述当前行驶车道在左右方向上的最短距离。

8.一种车辆，其特征在于，包括权利要求5-7中任一项所述的车辆自动驾驶时避障的系统。

Images