CN107145147B - 一种车辆低速自动驾驶避碰方法及系统 - Google Patents

一种车辆低速自动驾驶避碰方法及系统 Download PDF

Info

Publication number
CN107145147B
CN107145147B CN201710229720.9A CN201710229720A CN107145147B CN 107145147 B CN107145147 B CN 107145147B CN 201710229720 A CN201710229720 A CN 201710229720A CN 107145147 B CN107145147 B CN 107145147B
Authority
CN
China
Prior art keywords
vehicle
obstacle
path
collision
avoidance
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
CN201710229720.9A
Other languages
English (en)
Other versions
CN107145147A (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.)
Guangzhou Xiaopeng Motors Technology Co Ltd
Original Assignee
Guangzhou Xiaopeng Motors Technology Co Ltd
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 Guangzhou Xiaopeng Motors Technology Co Ltd filed Critical Guangzhou Xiaopeng Motors Technology Co Ltd
Priority to CN201710229720.9A priority Critical patent/CN107145147B/zh
Publication of CN107145147A publication Critical patent/CN107145147A/zh
Application granted granted Critical
Publication of CN107145147B publication Critical patent/CN107145147B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/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
    • 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
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • 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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
    • 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Acoustics & Sound (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)
  • Regulating Braking Force (AREA)

Abstract

本发明公开了一种车辆低速自动驾驶避碰方法及系统，该系统包括障碍物检测模块、碰撞风险判断模块及避让处理模块。该方法包括根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动。通过使用本发明的方法及系统，能提高车辆避碰的安全性、可靠性和稳定性，而且本发明的方案具有适用性广等优点。本发明作为一种车辆低速自动驾驶避碰方法及系统可广泛应用于车辆自动避碰领域中。

Description

一种车辆低速自动驾驶避碰方法及系统
技术领域
本发明涉及自动避碰技术，尤其涉及一种车辆低速自动驾驶避碰方法及系统。
背景技术
近年来，随着汽车的不断普及，电子控制技术的不断发展，汽车安全系统市场需求量越来越大，而且主动安全技术，特别是主动避碰技术，对于减少交通事故发挥的作用越来越大。
常用的主动避碰方案为，通过持续对车辆制动踏板的制动情况进行检测，若制动踏板被快速制动，则推断出存在碰撞危险，系统对车辆周围的物体相对于车辆的位置和运动进行检测，并评价碰撞危险，当系统判定仅采取制动不能避免碰撞而采取转向避让可以避免碰撞时，系统接管方向盘实现主动避让操作。但是这种方法存在一些缺陷，例如：1、通过制动踏板的快速制动来推断碰撞危险，系统容易产生误判断；2、驾驶员采取制动踏板的操作使得系统对车速的变化难以估计，车辆的实际避让轨迹与理论轨迹可能存在较大的偏差，避碰的可靠性低。因此为了解决这种传统避碰方案的缺点，目前提出的避碰方案为：对驾驶员的操作意图进行判断，结合传感器对周边环境的监测结果，综合判断是否满足系统主动介入的条件，若满足，则由系统自动实现避碰。然而，这种方案通常都是针对具体的某个驾驶行为(例如，紧急刹车、变道等)进行反应，没有普适性，当系统输出的避让转向与驾驶员的操作反向时则可能对驾驶员的人身安全造成威胁，此外，这种驾驶员驾驶过程中，系统突然介入获取车辆主动权的方式，会让驾驶员不知所措，可能会采取错误的操作，如果发生意外，法律责任难以界定。
发明内容
为了解决上述技术问题，本发明的目的是提供一种针对车辆低速自动驾驶工况的主动避碰方法，从而提高避碰的稳定性和可靠性。
本发明的另一目的是提供一种针对车辆低速自动驾驶工况的主动避碰系统，从而提高避碰的稳定性和可靠性。
本发明所采用的技术方案是：一种车辆低速自动驾驶避碰方法，该方法的步骤包括有：
根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；
当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；
当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动。
进一步，所述判断是否存有碰撞风险这一步骤，其具体包括：
判断检测出的障碍物是否处于车辆的规划行驶路径上，若是，则表示存有碰撞风险；反之，则判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉，若是，则表示存有碰撞风险，反之，则表示不存有碰撞风险。
进一步，所述判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉这一步骤，其具体包括：
计算出第一路径点，所述第一路径点指的是在规划行驶路径上距离障碍物最近的路径点；
在规划行驶路径上选取出以第一路径点为中心的第一路径；
将车辆后轮轴中心移动到第一路径中的路径点，并且以该路径点作为切点，从而以该路径点所在第一路径的切线方向放置车辆，然后计算车辆轮廓是否与障碍物轮廓相交。
进一步，所述计算车辆轮廓是否与障碍物轮廓相交这一步骤，其具体包括：
计算以下叉乘变量：
Figure BDA0001266292840000021
Figure BDA0001266292840000022
Figure BDA0001266292840000023
Figure BDA0001266292840000024
其中，k1k2表示为第一线段，所述第一线段指的是车辆轮廓的轮廓边，k1表示为第一线段的一端点，k2表示为第一线段的另一端点；h1h2表示为第二线段，所述第二线段指的是障碍物轮廓的轮廓边，h1表示为第二线段的一端点，h2表示为第二线段的另一端点；
然后，判断I1*I2与I3*I4是否均小于0，若是，则表示车辆轮廓与障碍物轮廓相交。
进一步，所述判断是否可以避让该障碍物这一步骤，其具体包括：
以最小转弯避让策略来进行避让行驶路线规划，当判断出车辆沿规划的避让行驶路线行驶时车辆轮廓与障碍物产生碰撞干涉，此时，则表示不可避让该障碍物；反之，则表示可避让该障碍物。
进一步，所述采用避让策略来控制车辆进行障碍物的避让这一步骤，其具体为：采用最小转弯避让策略或大转弯避让策略来控制车辆进行障碍物的避让；
所述采用最小转弯避让策略来控制车辆进行障碍物的避让这一步骤，其具体包括：
根据安全距离以及车辆的最小转弯半径，计算出可沿规划行驶路径的持续行驶距离，然后当车辆行驶完持续行驶距离时，控制车辆以最小转弯半径进行转弯，以实现障碍物的避让；
所述采用大转弯避让策略来控制车辆进行障碍物的避让这一步骤，其具体包括：
根据安全距离，计算出第一转弯半径，然后控制车辆以第一转弯半径进行转弯，以实现障碍物的避让；其中，所述第一转弯半径大于等于最小转弯半径。
进一步，所述根据安全距离，计算出第一转弯半径这一步骤，其所采用的第一转弯半径计算公式如下所示：
Figure BDA0001266292840000031
其中，d表示为车头到障碍物的垂直距离，L表示为车辆后轮轴中心到车头的垂直距离，Rm表示为计算得出的第一转弯半径，W表示为车辆的宽度，d1表示为安全距离。
进一步，所述控制车辆启动主动制动这一步骤，其具体包括：
计算车辆所需的减速度，其中，所述减速度的计算公式如下所示：
Figure BDA0001266292840000032
其中，a表示为计算得出的减速度，v表示为车辆当前的速度，d表示为车头到障碍物的垂直距离，dmin表示为最小安全距离；
判断计算得出的减速度是否大于车辆的最大减速度，若是，则利用车辆的最大减速度来控制车辆进行制动；反之，则利用计算得出的减速度来控制车辆进行制动。
进一步，该方法的步骤还包括中断检测步骤，所述中断检测步骤包括：
当检测到驾驶员的操作时，则中断自动驾驶避碰程序。
本发明所采用的另一技术方案是：一种车辆低速自动驾驶避碰系统，该系统包括：
障碍物检测模块，用于根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；
碰撞风险判断模块，用于当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；
避让处理模块，用于当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动。
进一步，所述判断是否存有碰撞风险，其具体包括：
判断检测出的障碍物是否处于车辆的规划行驶路径上，若是，则表示存有碰撞风险；反之，则判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉，若是，则表示存有碰撞风险，反之，则表示不存有碰撞风险。
进一步，所述判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉，其具体包括：
计算出第一路径点，所述第一路径点指的是在规划行驶路径上距离障碍物最近的路径点；
在规划行驶路径上选取出以第一路径点为中心的第一路径；
将车辆后轮轴中心移动到第一路径中的路径点，并且以该路径点作为切点，从而以该路径点所在第一路径的切线方向放置车辆，然后计算车辆轮廓是否与障碍物轮廓相交。
进一步，所述计算车辆轮廓是否与障碍物轮廓相交，其具体包括：
计算以下叉乘变量：
Figure BDA0001266292840000041
Figure BDA0001266292840000042
Figure BDA0001266292840000043
Figure BDA0001266292840000044
其中，k1k2表示为第一线段，所述第一线段指的是车辆轮廓的轮廓边，k1表示为第一线段的一端点，k2表示为第一线段的另一端点；h1h2表示为第二线段，所述第二线段指的是障碍物轮廓的轮廓边，h1表示为第二线段的一端点，h2表示为第二线段的另一端点；
然后，判断I1*I2与I3*I4是否均小于0，若是，则表示车辆轮廓与障碍物轮廓相交。
进一步，所述判断是否可以避让该障碍物，其具体包括：
以最小转弯避让策略来进行避让行驶路线规划，当判断出车辆沿规划的避让行驶路线行驶时车辆轮廓与障碍物产生碰撞干涉，此时，则表示不可避让该障碍物；反之，则表示可避让该障碍物。
进一步，所述采用避让策略来控制车辆进行障碍物的避让，其具体为：采用最小转弯避让策略或大转弯避让策略来控制车辆进行障碍物的避让；
所述采用最小转弯避让策略来控制车辆进行障碍物的避让，其具体包括：
根据安全距离以及车辆的最小转弯半径，计算出可沿规划行驶路径的持续行驶距离，然后当车辆行驶完持续行驶距离时，控制车辆以最小转弯半径进行转弯，以实现障碍物的避让；
所述采用大转弯避让策略来控制车辆进行障碍物的避让，其具体包括：
根据安全距离，计算出第一转弯半径，然后控制车辆以第一转弯半径进行转弯，以实现障碍物的避让；其中，所述第一转弯半径大于等于最小转弯半径。
进一步，所述第一转弯半径的计算公式如下所示：
Figure BDA0001266292840000051
其中，d表示为车头到障碍物的垂直距离，L表示为车辆后轮轴中心到车头的垂直距离，Rm表示为计算得出的第一转弯半径，W表示为车辆的宽度，d1表示为安全距离。
进一步，所述控制车辆启动主动制动，其具体包括：
计算车辆所需的减速度，其中，所述减速度的计算公式如下所示：
Figure BDA0001266292840000052
其中，a表示为计算得出的减速度，v表示为车辆当前的速度，d表示为车头到障碍物的垂直距离，dmin表示为最小安全距离；
判断计算得出的减速度是否大于车辆的最大减速度，若是，则利用车辆的最大减速度来控制车辆进行制动；反之，则利用计算得出的减速度来控制车辆进行制动。
进一步，该系统还包括中断检测模块，所述中断检测模块用于当检测到驾驶员的操作时，则中断自动驾驶避碰程序。
本发明的有益效果是：本发明方法是一种针对车辆低速自动驾驶工况的主动避碰方法，在车辆进行低速自动驾驶过程中，根据车载道路环境感知系统所监测到的道路环境参数，自动实时地检测车辆的规划行驶路径上是否存有障碍物，然后当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险，接着当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让，反之，则控制车辆启动主动制动，因此由此可见，本发明的方法无需对驾驶员的驾驶意图进行判断，对驾驶行为没有限制，其适应性更广，而且消除了传统车辆避碰系统突然介入获取车辆主动权这一缺陷，大大提高车辆避碰的安全性、可靠性和稳定性。还有本发明的方法通过对障碍物的检测、对避让策略的选择、制动动力的输出计算来实现避碰自动控制，更能提高自动驾驶避碰的安全性和可靠性。另外，本发明方法设置了驾驶员的操作的优先级为最高，当检测到驾驶员的操作时，则会中断自动驾驶避碰程序，后续便根据驾驶员的操作来控制车辆，可靠性、稳定性以及操作便利灵活性得到进一步的提高。
本发明的另一有益效果是：本发明系统是一种针对车辆低速自动驾驶工况的主动避碰系统，在车辆进行低速自动驾驶过程中，利用障碍物检测模块来自动实时地检测车辆的规划行驶路径上是否存有障碍物，然后当碰撞风险判断模块检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险，接着当避让处理模块判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让，反之，则控制车辆启动主动制动，因此由此可见，本发明的避碰系统无需对驾驶员的驾驶意图进行判断，对驾驶行为没有限制，其适应性更广，而且消除了传统车辆避碰系统突然介入获取车辆主动权这一缺陷，大大提高车辆避碰的安全性、可靠性和稳定性。还有本发明的系统通过对障碍物的检测、对避让策略的选择、制动动力的输出计算来实现避碰自动控制，更能提高自动驾驶避碰的安全性和可靠性。另外，本发明系统设置了中断检测模块，而驾驶员的操作的优先级为最高，当中断检测模块检测到驾驶员的操作时，则会中断自动驾驶避碰程序，后续便根据驾驶员的操作来控制车辆，可靠性、稳定性以及操作便利灵活性得到进一步的提高。
附图说明
图1是本发明一种车辆低速自动驾驶避碰方法的步骤流程示意图；
图2是本发明一种车辆低速自动驾驶避碰系统的结构框图；
图3是第一路径点的计算原理示意图；
图4是第一路径的示意图；
图5是障碍物轮廓和车辆轮廓示意图；
图6是两条线段相交的示意图；
图7是车辆避让规则原理示意图；
图8是不可避让障碍物的示意图；
图9是以最小转弯避让策略来实现障碍物避让的原理示意图；
图10是以大转弯避让策略来实现障碍物避让的原理示意图；
图11是主动制动时所需减速度的计算原理示意图。
具体实施方式
如图1所示，一种车辆低速自动驾驶避碰方法，该方法的步骤包括有：
根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；
当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；当检测不到车辆的规划行驶路径上存有障碍物时，则控制车辆按照规划行驶路径正常行驶；
当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动；当判断出不存有碰撞风险时，则控制车辆按照规划行驶路径正常行驶。
如图2所示，一种车辆低速自动驾驶避碰系统，该系统包括：
障碍物检测模块，用于根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；
碰撞风险判断模块，用于当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；
避让处理模块，用于当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动。
结合以下的具体实施例来对本发明的方法和系统做详细阐述。
在本发明方案中，所述低速指的是车速小于30km/h。
对于本发明的方案，其主要涉及的部件有：(1)、EPS电子助力转向机构，用于实现方向盘的自动转向控制；(2)、主动刹车系统，例如ABS，ESP等；(3)、车载道路环境感知系统，包括但不限于有毫米波雷达、超声波雷达、激光雷达、视觉感知模块等。
本发明一种车辆低速自动驾驶避碰方法，其实施步骤具体包括有：
启动车辆低速自动驾驶避碰程序，所述车辆低速自动驾驶避碰程序所实现的步骤包括有：
S101、根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；
S102、当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；当检测不到车辆的规划行驶路径上存有障碍物时，车辆则按照规划行驶路径正常行驶；
所述判断是否存有碰撞风险这一步骤，其具体包括：
判断检测出的障碍物是否处于车辆的规划行驶路径上，若是，则表示存有碰撞风险；反之，则判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉，若是，则表示存有碰撞风险，反之，则表示不存有碰撞风险；当不存有碰撞风险时，车辆则按照规划行驶路径正常行驶；
对于所述判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉这一步骤，其具体包括：
S1021、计算出第一路径点，所述第一路径点指的是在规划行驶路径上距离障碍物最近的路径点；
上述步骤S1021具体包括：在本实施例中，障碍物的轮廓被描述为凸多边形(即N多边形)，首先计算能够代表凸多边形“几何中心”的坐标，对于N多边形计算公式如下：
Figure BDA0001266292840000081
Figure BDA0001266292840000082
其中，(xi,yi)表示为N多边形第i个顶点的坐标，(x0,y0)表示为N多边形的“几何中心”坐标；
然后对规划行驶路径进行离散，从规划行驶路径的起点开始，每隔固定的距离△s，取一个路径上的点(即路径点)(Xi,Yi)，计算该路径点与障碍物的几何中心的距离，该距离计算公式如下所示：
Figure BDA0001266292840000083
通过上述公式进行路径点与障碍物几何中心之间距离的计算，便可找到最小的d值所对应的离散点P，该路径点则为所需计算得出的距离障碍物最近的路径点，即P点为第一路径点，如图3所示；
S1022、在规划行驶路径上选取出以第一路径点为中心的第一路径；
上述步骤S1022具体包括：判断最近点P附近一段路径上，车辆是否与障碍物发生干涉，这样一段路径的选择方式(即第一路径的选择方式)是：取最近点P及前后各m个路径离散点(即路径点)所构成的路径(即第一路径)，如图4所示；可见，对于Δs，其选择需要综合考虑计算效率(不能太小)及避免碰撞判断遗漏(不能太大)，而m的选择则与Δs相关，Δs越小，m越大，Δs越大，m越小；
S1023、将车辆后轮轴中心移动到第一路径中的路径点，并且以该路径点作为切点，从而以该路径点所在第一路径的切线方向放置车辆，然后计算车辆轮廓是否与障碍物轮廓相交；由于对于第一路径中的每一个路径点均需要进行一次上述的处理计算，即其总计需要对2m+1路径点进行计算判断，并且当任一个路径点上，计算出车辆轮廓与障碍物轮廓相交，则表示存有碰撞风险；
对于所述计算车辆轮廓是否与障碍物轮廓相交这一步骤，其具体包括：
如图5所示，设定障碍物Obj为四边形EFGH(不限制障碍物的多边形描述形式，在本实施例中仅以四边形为例进行说明而已)，则车辆轮廓与障碍物轮廓之间是否相交的判断过程为：ABCD四条边分别与EFGH四条边进行两两线段的相交判断，即此种情形对于一个路径点，则需要判断16次；而对于两条线段k1k2和h1h2是否相交，其判断原则为：k1，k2分别位于第二线段h1h2的两侧，同时h1，h2分别位于第一线段k1k2的两侧，如图6所示；
可见，为了计算车辆轮廓是否与障碍物轮廓相交，其具体实施步骤包括有：
首先计算计算以下叉乘变量：
Figure BDA0001266292840000091
Figure BDA0001266292840000092
Figure BDA0001266292840000093
Figure BDA0001266292840000094
其中，k1k2表示为第一线段，所述第一线段指的是车辆轮廓的轮廓边，k1表示为第一线段的一端点，k2表示为第一线段的另一端点；h1h2表示为第二线段，所述第二线段指的是障碍物轮廓的轮廓边，h1表示为第二线段的一端点，h2表示为第二线段的另一端点；
然后，判断I1*I2的乘积值与I3*I4乘积值是否同时均小于0，若是，则表示车辆轮廓的轮廓边与障碍物轮廓的轮廓边相交，即车辆沿规划行驶路径行驶时车辆轮廓与障碍物产生碰撞干涉，存有碰撞风险；
S103、当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动；
对于所述的步骤S103，其所遵循的避让规则是(如图7所示)：当障碍物处于规划行驶路径上时，遵循左转避让规则(符合中国超车原则)；当障碍物处于规划行驶路径偏左侧时，遵循右转避让规则；当障碍物处于规划行驶路径偏右侧时，遵循左转避让规则；
对于所述判断是否可以避让该障碍物这一步骤，其具体包括：
以最小转弯避让策略来进行避让行驶路线规划，令车辆在判断出存有碰撞风险时，以最小转弯半径Rmin(最大转向角)进行避让，当判断出车辆沿规划的避让行驶路线行驶时车辆轮廓与障碍物产生碰撞干涉，如图8所示，此时，则表示不可避让该障碍物；反之，则表示可避让该障碍物；通常，出现不可避让该障碍物的情况是由于发现障碍物时的距离d过近或突然出现在车辆近处的障碍物；
a.当判断出可避让该障碍物时，则采用最小转弯避让策略或大转弯避让策略来控制车辆进行障碍物的避让；
①、所述采用最小转弯避让策略来控制车辆进行障碍物的避让这一步骤，如图9所示，其具体包括：根据安全距离d1以及车辆的最小转弯半径Rmin，计算出可沿规划行驶路径的持续行驶距离S，然后当车辆行驶完持续行驶距离S(即从P0行驶至P1)时，控制车辆以最小转弯半径Rmin进行转弯，以实现障碍物的避让；其中，对于所述的最小转弯半径Rmin，其由车辆的转向机构及车辆轴距决定，对于每一辆车其是一个固定值；
对于这种避让策略，其可以保证自动驾驶车辆最大限度地沿着原路径行驶，然而避让过程会使得车辆的航向角(横摆角)与路径方向有较大的偏差，避障过程车辆发生的横向位移大，因此这一策略适用于道路较宽的情况；
②、所述采用大转弯避让策略来控制车辆进行障碍物的避让这一步骤，其具体包括：
令车辆在判断出可避让该障碍物时，采用较大的转弯半径来控制车辆进行障碍物的避让，如图10所示；其中，所述较大的转弯半径，其为根据安全距离d1而计算出的第一转弯半径Rm，Rm应大于等于Rmin，并且Rm的计算公式如下所示：
Figure BDA0001266292840000101
其中，d表示为车头到障碍物的垂直距离，L表示为车辆后轮轴中心到车头的垂直距离，Rm表示为计算得出的第一转弯半径，W表示为车辆的宽度，d1表示为安全距离；
对于这种避让策略，其会使得车辆与原路径的偏离会持续较长的一段路程，但是绕障后车辆航向角与原路径方向偏差较小，避障过程车辆发生的横向位移小，因此这一策略适用于道路较窄的情况；
对于上述的安全距离d1，其表示车辆绕过障碍物时车辆轮廓与障碍物之间的最近距离，而在设计避让策略时，关于安全距离d1的设定，其仅需要满足d1>dmin这一条件便可，其中，dmin表示为系统所设定的绕障最小安全距离；优选地，d1的取值应为：d1＝1.2*dmin；
b.当判断出不可避让该障碍物时，则控制车辆启动主动制动，其具体包括：
计算车辆所需的减速度，其中，所述减速度的计算公式如下所示：
Figure BDA0001266292840000111
其中，a表示为计算得出的减速度，v表示为车辆当前的速度，d表示为车头到障碍物的垂直距离，dmin表示为最小安全距离，如图11所示；
判断计算得出的减速度a是否大于车辆的最大减速度amax，若是，则说明车辆的制动系统不能保证最小安全距离，此时则利用车辆的最大减速度amax来控制车辆进行制动，从而避免或减小碰撞损失；反之，则利用计算得出的减速度a来控制车辆进行制动。
作为本实施例的优选实施方式，对于上述的车辆低速自动驾驶避碰方法，其还包括中断检测步骤，所述中断检测步骤包括：
由于驾驶员的操作被设置为最高优先级，当检测到驾驶员的操作时，则中断上述的车辆低速自动驾驶避碰程序，然后以驾驶员的操作来控制车辆。
由上述可得，本发明的方法及系统为针对低速自动驾驶工况的自动驾驶避碰方案，其不需要判断驾驶员的驾驶意图，对驾驶行为没有限制，适应性更广；而且能自动判断并采取转向避让或刹车策略，车辆的转向、动力和制动通过线控的方式实现自动控制，对避让路径的选择及执行、制动力大小的输出更稳定可靠。此外，本发明方案还设置驾驶员的优先级最高，驾驶员可以随时中断系统，接管车辆。
以上是对本发明的较佳实施进行了具体说明，但本发明创造并不限于所述实施例，熟悉本领域的技术人员在不违背本发明精神的前提下还可做作出种种的等同变形或替换，这些等同的变形或替换均包含在本申请权利要求所限定的范围内。

Claims (8)

1.一种车辆低速自动驾驶避碰方法，其特征在于：该方法的步骤包括有：
根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；
当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；其中，所述判断是否存有碰撞风险这一步骤，其具体包括：
判断检测出的障碍物是否处于车辆的规划行驶路径上，若是，则表示存有碰撞风险；
反之，则判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉，若是，则表示存有碰撞风险，反之，则表示不存有碰撞风险；其中，所述判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉这一步骤，其具体包括：
计算出第一路径点，所述第一路径点指的是在规划行驶路径上距离障碍物最近的路径点；
在规划行驶路径上选取出以第一路径点为中心的第一路径；
将车辆后轮轴中心移动到第一路径中的路径点，并且以该路径点作为切点，从而以该路径点所在第一路径的切线方向放置车辆，然后计算车辆轮廓是否与障碍物轮廓相交；
当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动；其中，所述避让策略包括最小转弯避让策略和大转弯避让策略。
2.根据权利要求1所述一种车辆低速自动驾驶避碰方法，其特征在于：所述计算车辆轮廓是否与障碍物轮廓相交这一步骤，其具体包括：
计算以下叉乘变量：
Figure FDA0002539382480000011
Figure FDA0002539382480000012
Figure FDA0002539382480000013
Figure FDA0002539382480000014
其中，k1k2表示为第一线段，所述第一线段指的是车辆轮廓的轮廓边，k1表示为第一线段的一端点，k2表示为第一线段的另一端点；h1h2表示为第二线段，所述第二线段指的是障碍物轮廓的轮廓边，h1表示为第二线段的一端点，h2表示为第二线段的另一端点；
然后，判断I1*I2与I3*I4是否均小于0，若是，则表示车辆轮廓与障碍物轮廓相交。
3.根据权利要求1-2任一项所述一种车辆低速自动驾驶避碰方法，其特征在于：所述判断是否可以避让该障碍物这一步骤，其具体包括：
以最小转弯避让策略来进行避让行驶路线规划，当判断出车辆沿规划的避让行驶路线行驶时车辆轮廓与障碍物产生碰撞干涉，此时，则表示不可避让该障碍物；反之，则表示可避让该障碍物。
4.根据权利要求1-2任一项所述一种车辆低速自动驾驶避碰方法，其特征在于：所述采用避让策略来控制车辆进行障碍物的避让这一步骤，其具体为：采用最小转弯避让策略或大转弯避让策略来控制车辆进行障碍物的避让；
所述采用最小转弯避让策略来控制车辆进行障碍物的避让这一步骤，其具体包括：
根据安全距离以及车辆的最小转弯半径，计算出可沿规划行驶路径的持续行驶距离，然后当车辆行驶完持续行驶距离时，控制车辆以最小转弯半径进行转弯，以实现障碍物的避让；
所述采用大转弯避让策略来控制车辆进行障碍物的避让这一步骤，其具体包括：
根据安全距离，计算出第一转弯半径，然后控制车辆以第一转弯半径进行转弯，以实现障碍物的避让；其中，所述第一转弯半径大于等于最小转弯半径。
5.根据权利要求4所述一种车辆低速自动驾驶避碰方法，其特征在于：所述根据安全距离，计算出第一转弯半径这一步骤，其所采用的第一转弯半径计算公式如下所示：
Figure FDA0002539382480000021
其中，d表示为车头到障碍物的垂直距离，L表示为车辆后轮轴中心到车头的垂直距离，Rm表示为计算得出的第一转弯半径，W表示为车辆的宽度，d1表示为安全距离。
6.根据权利要求1-2任一项所述一种车辆低速自动驾驶避碰方法，其特征在于：所述控制车辆启动主动制动这一步骤，其具体包括：
计算车辆所需的减速度，其中，所述减速度的计算公式如下所示：
Figure FDA0002539382480000022
其中，a表示为计算得出的减速度，v表示为车辆当前的速度，d表示为车头到障碍物的垂直距离，dmin表示为最小安全距离；
判断计算得出的减速度是否大于车辆的最大减速度，若是，则利用车辆的最大减速度来控制车辆进行制动；反之，则利用计算得出的减速度来控制车辆进行制动。
7.根据权利要求1-2任一项所述一种车辆低速自动驾驶避碰方法，其特征在于：该方法的步骤还包括中断检测步骤，所述中断检测步骤包括：
当检测到驾驶员的操作时，则中断自动驾驶避碰程序。
8.一种车辆低速自动驾驶避碰系统，其特征在于：该系统包括：
障碍物检测模块，用于根据车载道路环境感知系统所监测到的道路环境参数，从而检测车辆的规划行驶路径上是否存有障碍物；
碰撞风险判断模块，用于当检测到车辆的规划行驶路径上存有障碍物时，则判断是否存有碰撞风险；其中，所述判断是否存有碰撞风险这一步骤，其具体包括：
判断检测出的障碍物是否处于车辆的规划行驶路径上，若是，则表示存有碰撞风险；反之，则判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉，若是，则表示存有碰撞风险，反之，则表示不存有碰撞风险；其中，所述判断车辆沿规划行驶路径行驶时车辆轮廓是否与障碍物产生碰撞干涉这一步骤，其具体包括：
计算出第一路径点，所述第一路径点指的是在规划行驶路径上距离障碍物最近的路径点；
在规划行驶路径上选取出以第一路径点为中心的第一路径；
将车辆后轮轴中心移动到第一路径中的路径点，并且以该路径点作为切点，从而以该路径点所在第一路径的切线方向放置车辆，然后计算车辆轮廓是否与障碍物轮廓相交；
避让处理模块，用于当判断出存有碰撞风险时，则判断是否可以避让该障碍物，若是，则采用避让策略来控制车辆进行障碍物的避让；反之，则控制车辆启动主动制动；其中，所述避让策略包括最小转弯避让策略和大转弯避让策略。
CN201710229720.9A 2017-04-10 2017-04-10 一种车辆低速自动驾驶避碰方法及系统 Active CN107145147B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710229720.9A CN107145147B (zh) 2017-04-10 2017-04-10 一种车辆低速自动驾驶避碰方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710229720.9A CN107145147B (zh) 2017-04-10 2017-04-10 一种车辆低速自动驾驶避碰方法及系统

Publications (2)

Publication Number Publication Date
CN107145147A CN107145147A (zh) 2017-09-08
CN107145147B true CN107145147B (zh) 2020-12-15

Family

ID=59773626

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710229720.9A Active CN107145147B (zh) 2017-04-10 2017-04-10 一种车辆低速自动驾驶避碰方法及系统

Country Status (1)

Country Link
CN (1) CN107145147B (zh)

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6832421B2 (ja) 2018-03-08 2021-02-24 バイドゥドットコム タイムズ テクノロジー （ベイジン） カンパニー リミテッドＢａｉｄｕ．ｃｏｍ Ｔｉｍｅｓ Ｔｅｃｈｎｏｌｏｇｙ （Ｂｅｉｊｉｎｇ） Ｃｏ．， Ｌｔｄ． シミュレーションに基づく自動運転車の感知要求の評価方法
US10549749B2 (en) * 2018-03-08 2020-02-04 Baidu Usa Llc Post collision analysis-based vehicle action optimization for autonomous driving vehicles
CN108831175A (zh) * 2018-04-19 2018-11-16 北京汽车股份有限公司 车辆导航控制方法、装置及车辆
CN110654377A (zh) * 2018-06-29 2020-01-07 上海汽车集团股份有限公司 一种车辆防撞控制方法及控制系统
CN109557925B (zh) * 2018-12-29 2021-12-10 北京智行者科技有限公司 自动驾驶车辆障碍物避让方法及装置
CN109878513A (zh) 2019-03-13 2019-06-14 百度在线网络技术（北京）有限公司 防御性驾驶策略生成方法、装置、设备及存储介质
CN110530390A (zh) * 2019-09-16 2019-12-03 哈尔滨工程大学 一种在狭窄环境下的非质点车辆路径规划方法
CN111538335A (zh) * 2020-05-15 2020-08-14 深圳国信泰富科技有限公司 一种驾驶机器人的防碰撞方法
CN111634292B (zh) * 2020-05-18 2021-10-19 北京踏歌智行科技有限公司 一种用于矿区的碰撞预测方法
CN111679678B (zh) * 2020-06-30 2022-04-08 安徽海博智能科技有限责任公司 一种横纵向分离的轨迹规划方法、系统及计算机设备
CN112130563B (zh) * 2020-09-10 2022-04-29 东风汽车集团有限公司 一种多目标筛选辅助驾驶控制方法
CN114185337B (zh) * 2020-09-15 2023-08-04 宇通客车股份有限公司 一种车辆、车辆预碰撞检测方法及装置
CN112327886A (zh) * 2020-12-04 2021-02-05 盐城中科高通量计算研究院有限公司 一种巡逻车用自主避障决策方法
CN112650243B (zh) 2020-12-22 2023-10-10 北京百度网讯科技有限公司 车辆控制方法、装置、电子设备和自动驾驶车辆
CN112744217B (zh) * 2021-03-10 2022-12-06 北京车和家信息技术有限公司 碰撞检测方法、行驶路径的推荐方法及其装置和存储介质
CN113650607B (zh) * 2021-07-20 2023-06-06 江铃汽车股份有限公司 一种低速场景自动驾驶方法、系统及汽车
CN113734164B (zh) * 2021-09-07 2022-04-19 北京三快在线科技有限公司 无人车的控制方法、装置、存储介质及电子设备
CN113823123B (zh) * 2021-09-28 2022-07-01 合肥工业大学 一种基于离散点轨迹拟合的车辆避障预警方法及装置
CN114056328B (zh) * 2021-11-01 2024-04-26 中国电子科技南湖研究院 基于dqn实现车辆l3级自动驾驶的行人避让方法及系统
CN114103957B (zh) * 2021-12-22 2024-02-06 阿波罗智联(北京)科技有限公司 变道控制方法、装置、电子设备和存储介质
CN114407879B (zh) * 2022-01-17 2023-06-02 常州信息职业技术学院 一种适用于自动驾驶的应急转向控制系统及控制方法
CN115014375B (zh) * 2022-06-06 2023-11-03 北京京深深向科技有限公司 碰撞检测方法、装置及电子设备、存储介质
CN115237124A (zh) * 2022-06-30 2022-10-25 魔门塔(苏州)科技有限公司 行驶路径边界确定方法及装置、车辆、存储介质、终端

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2008032673A1 (fr) * 2006-09-11 2008-03-20 Hitachi, Ltd. Dispositif mobile
JP2016081403A (ja) * 2014-10-21 2016-05-16 株式会社Ｉｈｉエアロスペース 無人移動体とその経路生成方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102171084B (zh) * 2008-09-30 2013-12-04 日产自动车株式会社 配置有用于辅助系统操作员的辅助控制器的系统、控制操作辅助装置、控制操作辅助方法、驾驶操作辅助装置和驾驶操作辅助方法
CN103335658B (zh) * 2013-06-19 2016-09-14 华南农业大学 一种基于弧线路径生成的自主车辆避障方法
EP2821307B1 (en) * 2013-07-03 2016-09-28 Volvo Car Corporation A vehicle system, a vehicle and a method for autonomous road irregularity avoidance
EP2949548B1 (en) * 2014-05-27 2018-07-11 Volvo Car Corporation Lane keeping suppressing system and method
CN104002807A (zh) * 2014-05-28 2014-08-27 长城汽车股份有限公司 一种汽车安全驾驶控制方法及系统
US9229453B1 (en) * 2014-08-29 2016-01-05 GM Global Technology Operations LLC Unified motion planner for autonomous driving vehicle in avoiding the moving obstacle
US10684133B2 (en) * 2015-07-22 2020-06-16 Honda Motor Co., Ltd. Route generator, route generation method, and route generation program
CN105261224B (zh) * 2015-09-02 2017-09-12 奇瑞汽车股份有限公司 智能车辆控制方法和装置

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2008032673A1 (fr) * 2006-09-11 2008-03-20 Hitachi, Ltd. Dispositif mobile
JP2016081403A (ja) * 2014-10-21 2016-05-16 株式会社Ｉｈｉエアロスペース 無人移動体とその経路生成方法

Also Published As

Publication number Publication date
CN107145147A (zh) 2017-09-08

Similar Documents

Publication Publication Date Title
CN107145147B (zh) 一种车辆低速自动驾驶避碰方法及系统
EP3611069B1 (en) Vehicle control device
JP6035207B2 (ja) 車両制御システム
JP6108974B2 (ja) 車両制御システム
JP5300357B2 (ja) 衝突防止支援装置
US9796422B2 (en) Vehicle control system configured to recognize travel environment in which vehicle travels, and to provide drive assist
US9852633B2 (en) Travel assist apparatus and travel assist method
US9969384B2 (en) Vehicle control system
JP7443177B2 (ja) 衝突回避支援装置
US9643600B2 (en) Vehicle control system
WO2013046301A1 (ja) 車両の運転支援システム
WO2012043665A1 (ja) 走行支援装置及び方法
JP7470588B2 (ja) 衝突回避支援装置
EP3549838A1 (en) Vehicle control device
JP7272255B2 (ja) 運転支援装置
CN110758392A (zh) 一种客车用自主变道控制方法
US11760344B2 (en) Collision avoidance assist apparatus
CN110758391A (zh) 一种客车用自适应巡航acc系统控制方法
JP7283463B2 (ja) 衝突回避装置
CN113232648A (zh) 针对弱势道路使用者的汽车避撞系统及其控制方法
CN113844439B (zh) 一种用于辅助驾驶的低速辅助制动辅助决策方法、系统及计算机可读存储介质
JP2024079109A (ja) 車両の走行制御装置
JP2024079110A (ja) 車両の走行制御装置
CN114104003A (zh) 一种车辆控制方法
CN114179797A (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
CP02 Change in the address of a patent holder
CP02 Change in the address of a patent holder

Address after: 510000 No.8 Songgang street, Cencun, Tianhe District, Guangzhou City, Guangdong Province

Patentee after: GUANGZHOU XPENG AUTOMOBILE TECHNOLOGY Co.,Ltd.

Address before: Room 2081, building 2, No.8, Fenghuang Third Road, Zhongxin Guangzhou Knowledge City, Guangzhou 510000

Patentee before: GUANGZHOU XPENG AUTOMOBILE TECHNOLOGY Co.,Ltd.