[发明专利]一种基于人工势场法的车辆主动避撞方法

权利要求书

1.一种基于人工势场法的车辆主动避撞方法，其特征在于：包括以下步骤，

步骤(A)，获取车辆自身与环境信息；

步骤(B)，通过分析车辆自身与环境信息，建立车辆斥力人工势场模型，得到车辆当前所受虚拟斥力；

步骤(C)，通过车辆可见障碍物斥力以及盲区虚拟斥力判断是否需要进行主动避撞；

步骤(D)，在需要进行主动避撞时，利用人工势场模型规划主动避撞路径；

步骤(E)，按照步骤(D)所规划的路径由电子控制单元ECU控制避撞；

步骤(F)，对当前驾驶员操作输入进行判断，决策是否归还车辆控制权；

步骤(G)，单位时间之后，重复步骤(A)至步骤(F)直到车辆到达安全地点。

2.根据权利要求1所述的一种基于人工势场法的车辆主动避撞方法，其特征在于：步骤(A)，所描述的车辆自身与环境信息通过激光雷达与CCD工业相机获取，所获取的车辆自身与环境信息包括有，

(A1)，当前行驶道路两侧障碍物信息；

(A2)，当前行驶前方障碍物信息；

(A3)，当前交通信号灯信息；

(A4)，当前传感器视野盲区信息。

3.根据权利要求1所述的一种基于人工势场法的车辆主动避撞方法，其特征在于：步骤(B)，所描述的车辆当前所受虚拟斥力包括下列斥力，

(B1)，前方及侧向障碍物斥力

其中，为障碍物与车辆相对距离，为障碍物与车辆相对速度，M_vehicle为车辆当前运动状态，S_safe-r为障碍物与车辆理论安全距离；

(B2)，信号指示灯斥力

其中，为车辆与交通信号灯相对距离，S_safe为车辆与交通信号灯安全距离阈值，M_light为信号灯当前显示；S_safe-light为车辆与交通信号灯理论安全距离；

(B3)，前方检测盲区斥力

其中，为车辆与盲区边界相对距离，为车辆与盲区边界相对速度，S_safe-blind为车辆与盲区边界理论安全距离。

4.根据权利要求1所述的一种基于人工势场法的车辆主动避撞方法，其特征在于：步骤(C)，所描述的汽车主动避撞判断，采用阈值判断，分别计算可见障碍物斥力与盲区潜在障碍物斥力，若计算结果大于对应斥力阈值，则判定需要进行主动避撞操作。

5.根据权利要求1所述的一种基于人工势场法的车辆主动避撞方法，其特征在于：步骤(D)，所描述的人工势场模型包括当前环境下的虚拟斥力、虚拟引力，其中，虚拟引力包括当前全局规划虚拟引力、安全换道虚拟引力；虚拟斥力包括前方障碍物斥力、信号指示灯斥力、侧向障碍物斥力、前方检测盲区斥力。

6.根据权利要求1所述的一种基于人工势场法的车辆主动避撞方法，其特征在于：步骤(D)，所描述的人工势场模型规划主动避撞路径，其方法为：求出待规划位置所受所有斥力与引力的合力，合力方向为该位置车辆的理想避撞规划方向。

7.根据权利要求1所述的一种基于人工势场法的车辆主动避撞方法，其特征在于：步骤(F)，所描述的当前驾驶员操作反馈进行判断决策的具体方法为：

计算驾驶员当前操作安全系数：K_driver＝f(δ_d-p,N_d-p)。其中δ_d-p为驾驶员当前操作与理论安全操作方向盘输入差值，N_d-p为驾驶员当前操作与理论安全操作油门与刹车信号输入差值，若操作安全系数大于预设阈值则判定为不安全操作，反之判定为安全操作。