[发明专利]一种基于势场力的车辆主动避障控制方法及系统

权利要求书

1.一种基于势场力的车辆主动避障控制方法，其特征在于，包括：

当障碍车辆驶入主车辆所在车道的前方区域且所述主车辆陷入局部极小值点时，实时获取所述主车辆对应的第一坐标信息和所述障碍车辆对应的第二坐标信息；

按照预设的势场力预测算法，结合所述第一坐标信息和所述第二坐标信息，计算得到所述主车辆对应的第一势场力，并利用所述第一势场力，控制所述主车辆行驶至虚拟目标点；

其中，所述第一坐标信息为所述主车辆的中心点的坐标信息，所述第二坐标信息为所述障碍车辆的中心点的坐标信息。

2.如权利要求1所述的一种基于势场力的车辆主动避障控制方法，其特征在于，所述按照预设的势场力预测算法，结合所述第一坐标信息和所述第二坐标信息，计算得到所述主车辆对应的第一势场力，并利用所述第一势场力，控制所述主车辆行驶至虚拟目标点，具体为：

根据空间几何关系，结合所述第一坐标信息和所述第二坐标信息，确定所述虚拟目标点对应的第三坐标信息，并根据所述第一坐标信息和所述第三坐标信息，计算得到所述主车辆的中心点和所述虚拟目标点之间的距离；

按照预设的势场力预测算法，结合所述主车辆的中心点和所述虚拟目标点之间的距离，计算得到所述主车辆对应的所述第一势场力；

利用所述第一势场力，控制所述主车辆行驶至所述虚拟目标点。

3.如权利要求1所述的一种基于势场力的车辆主动避障控制方法，其特征在于，所述主车辆陷入局部极小值点的判断，具体为：

当所述障碍车辆驶入所述主车辆所在车道的前方区域时，获取当前所述主车辆对应的第一势能和下一时刻所述主车辆对应的第二势能，并判断所述第一势能是否小于所述第二势能；其中，所述第一势能为结合当前所述主车辆对应的第一道路危险势能、第一道路引力势能和第一障碍车辆危险势能而获得的，所述第二势能为结合下一时刻所述主车辆对应的第二道路危险势能、第二道路引力势能和第二障碍车辆危险势能而获得的；

若是，则确定当前所述主车辆陷入局部极小值点；

若否，则确定当前所述主车辆并未陷入局部极小值点，并控制所述主车辆朝着当前行驶方向继续行驶。

4.如权利要求1所述的一种基于势场力的车辆主动避障控制方法，其特征在于，还包括：

实时获取所述主车辆和所述障碍车辆之间的纵向距离，并判断当前所述纵向距离是否小于预设的车辆间安全距离；其中，所述纵向距离为当前所述障碍车辆对应的所述第二坐标信息中的第二纵坐标和当前所述主车辆对应的所述第一坐标信息中的第一纵坐标的差值的绝对值，所述车辆间安全距离是由所述主车辆的当前车速、所述障碍车辆的当前车速、以及所述障碍车辆的车身长度而计算得到的；

若是，则按照预设的实时势场力算法，根据当前所述纵向距离、当前所述第一坐标信息和当前所述第二坐标信息，计算得到当前所述主车辆对应的第二势场力，并利用所述第二势场力，控制所述主车辆进行主动避障；

若否，则控制所述主车辆朝着当前行驶方向继续行驶。

5.如权利要求4所述的一种基于势场力的车辆主动避障控制方法，其特征在于，所述按照预设的实时势场力算法，根据当前所述纵向距离、当前所述第一坐标信息和当前所述第二坐标信息，计算得到当前所述主车辆对应的第二势场力，具体为：

按照预设的实时势场力算法，根据当前所述纵向距离、势场影响距离、当前所述第一坐标信息和当前所述第二坐标信息，计算得到当前所述主车辆在道路横向上受到的道路横向斥力、道路横向引力和障碍车辆横向斥力，以及当前所述主车辆在道路纵向上受到的道路纵向斥力、道路纵向引力和障碍车辆纵向斥力；

根据所述道路横向斥力、所述道路横向引力、所述障碍车辆横向斥力、所述道路纵向斥力、所述道路纵向引力和所述障碍车辆纵向斥力，计算得到当前所述主车辆对应的所述第二势场力；

其中，所述势场影响距离是根据所述车辆间安全距离计算得到。