1.一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于,包括以下内容;
其包括摄像头感知评价指标单元、换道决策单元、换道路径规划单元、列队车距保持单元;
所述的商用车为无人驾驶车辆,商用车列队由三辆车组成;
所述摄像头感知评价指标单元用于计算空间距离评价因子、交通参与物运动与姿态评价因子、交通标识评价因子,从而通过评价指标公式计算出摄像头感知评价指标;空间距离评价因子取决于第一辆车的速度、第二辆车的速度、第三辆车的速度、空间坐标变换因子,其中,空间坐标变换因子取决于大地坐标系下的第一辆车的中心坐标(,,)、大地坐标系下第二辆车的中心坐标(,,)、大地坐标系下第三辆车的中心坐标(,,);交通参与物运动与姿态评价因子取决于第一辆车的速度、第二辆车的速度、第三辆车的速度、第一辆车的加速度、第二辆车的加速度、第三辆车的加速度;交通标识评价因子取决于色彩转换因子、路面噪点评价综合系数、路况评价系数,其中,色彩转换因子取决于三通道色彩参数,分别为第一通道色彩参数、第二通道色彩参数、第三通道色彩参数;
所述换道决策单元包括三种换道指令:跟驰行驶、等待换道、执行换道;根据安全第一的准则,跟驰行驶指令作为优先级,等待换道指令作为次优先级,执行换道指令为最后一级,通过设计跟驰行驶意愿阈值、等待换道意愿阈值、执行换道意愿阈值来描述换道意愿的强度,其中;当摄像头感知评价指标K满足时,所述换道决策单元执行跟驰行驶指令,当摄像头感知评价指标K满足时,所述换道决策单元执行等待换道指令,当摄像头感知评价指标K满足时,所述换道决策单元执行换道指令;
所述换道路径规划单元用于接收换道决策单元发送的换道意愿指令,并在获得跟驰行驶指令、等待换道指令、执行换道指令三种指令中的一种后,根据路径规划算法规划出下一时段的路径簇,随后通过代价函数计算出所规划的路径簇的代价估计值,在保证车辆安全行驶的前提下选取最小的路径作为最优规划路径行驶;
所述列队车距保持单元用于计算探测距离综合系数、油门踏板强度、制动踏板强度;探测距离综合系数取决于传感器灵敏度系数、坐标综合判断系数、车辆前方搭载摄像头个数、车辆后方搭载摄像头个数,其中,坐标综合判断系数取决于车体坐标系下第一辆车的中心坐标(,,)、车体坐标系下第二辆车的中心坐标(,,)、车体坐标系下第三辆车的中心坐标(,,);油门踏板强度取决于第一辆车与第二辆车的实际距离、第二辆车与第三辆车的实际距离、第一辆车的速度、第二辆车的速度、第三辆车的速度;制动踏板强度取决于第一辆车与第二辆车的实际距离、第二辆车与三辆车的实际距离、第一辆车的速度、第二辆车的速度、第三辆车的速度;
在完成路径规划后,需要对商用车进行列队车距保持控制,在对车辆进行车距控制时需计算出探测距离综合系数,再根据探测距离综合系数计算出保持车距需要的油门踏板强度和制动踏板强度,所述列队车距保持单元,根据以下公式可以计算探测距离综合系数:,
其中,、为加权系数,为传感器灵敏度系数,为坐标综合判断系数,为车辆前方搭载摄像头个数,为车辆后方搭载摄像头个数,为车辆前方搭载摄像头离地高度,为车辆后方搭载摄像头离地高度,为车辆前方搭载摄像头俯视角,为车辆后方搭载摄像头俯视角,为车辆前方搭载摄像头仰视角,为车辆后方搭载摄像头仰视角,坐标综合判断系数的表达式如下:,
其中,(,,)为车体坐标系下第一辆车的中心坐标,(,,)为车体坐标系下第二辆车的中心坐标,(,,)为车体坐标系下第三辆车的中心坐标。
2.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:所述摄像头感知评价指标单元,根据以下公式可计算空间距离评价因子:,
其中,为自然常数,为第一辆车的速度,为第二辆车的速度,为第三辆车的速度,为空间坐标变换因子,其取值取决于大地坐标系下第一辆车的中心坐标(,,)、大地坐标系下第二辆车的中心坐标(,,)、大地坐标系下第三辆车的中心坐标(,,),空间坐标变换因子的表达式如下;
,
其中,为加权系数。
3.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:所述摄像头感知评价指标单元,根据以下公式可计算交通参与物运动与姿态评价因子:,
其中,、、为加权系数,为第一辆车的速度,为第二辆车的速度,为第三辆车的速度,为第一辆车的加速度,为第二辆车的加速度,为第三辆车的加速度,为道路纵坡,为道路横坡,为交通参与物固有亮度对比。
4.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:所述摄像头感知评价指标单元,根据以下公式可计算交通标识评价因子:,
其中,为自然常数,、、为加权系数,为色彩转换因子,为路面噪点评价综合系数,为路况评价系数,色彩转换因子取决于三通道色彩参数,为第一通道色彩参数、为第二通道色彩参数、为第三通道色彩参数,的表达式如下:,
其中,为自然常数。
5.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:所述摄像头感知评价指标单元,根据以下公式可计算摄像头感知评价指标:,
其中,为空间距离评价因子、为交通参与物运动与姿态评价因子、为交通标识评价因子。
6.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:所述换道决策单元包括三种换道指令:跟驰行驶、等待换道、执行换道;根据安全第一的准则,跟驰行驶指令作为优先级,等待换道指令作为次优先级,执行换道指令为最后一级,通过设计跟驰行驶意愿阈值、等待换道意愿阈值、执行换道意愿阈值来描述换道意愿的强度,其中。
7.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:在接收完换道决策单元发送的换道意愿指令后,所述换道路径规划单元根据路径规划算法规划出下一时段的路径簇,随后通过代价函数计算出所规划的路径簇的代价估计值,在保证车辆安全行驶的前提下选取最小的路径作为最优规划路径行驶,路径簇的代价估计值表达式如下:,
其中,表示代价估计加权值,为站点d的坐标,为站点d的代价函数值,为代价函数,站点d的估价函数值的表达式如下:,
其中,为起点到站点d的代价函数值,为站点d到终点的代价函数值。
8.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:在完成路径规划后,需要对商用车进行列队车距保持控制,车辆机构执行的措施是控制油门踏板强度和制动踏板强度,所述列队车距保持单元,根据以下公式可以计算油门踏板强度:,
为自然常数,为第一辆车与第二辆车的实际距离,为第二辆车与第三辆车的实际距离,为第一辆车的速度,为第二辆车的速度,为第三辆车的速度,为探测距离综合系数。
9.根据权利要求1所述一种基于摄像头感知决策和路径规划的商用车列队跟驰方法,其特征在于:在完成路径规划后,需要对商用车进行列队车距保持控制,车辆机构执行的措施是控制油门踏板强度和制动踏板强度,所述列队车距保持单元,根据以下公式可以计算制动踏板强度:,
为自然常数,为第一辆车与第二辆车的实际距离,为第二辆车与第三辆车的实际距离,为第一辆车的速度,为第二辆车的速度,为第三辆车的速度,为探测距离综合系数。