1.一种防碰撞的动态智能网联车辆M最优换道轨迹规划方法,其特征在于:包括以下步骤:S1、建立智能网联车辆M基于五次多项式的换道轨迹规划方程;
所述步骤S1的轨迹方程建立过程具体步骤如下:S1.1、换道运动解耦为两个正交方向:纵向(X方向)和横向(Y方向),利用五次多项式构建智能网联车辆M每个方向上的轨迹规划方程;
所述步骤S1.1中的轨迹规划方程表达式:其中,x(t)和y(t)分别表示车辆在t时刻的纵向位置和横向位置,aS1.2、建立智能网联车辆M在换道初始时刻t所述步骤S1.2中位移、速度和加速度方程表达式如下:其中,x(t
S1.3、对相关变量进行初始化;
所述步骤S1.3的初始化表达式如下:
其中,x
S1.4、对步骤S1中的轨迹规划方程系数进行计算;
S2、构建智能网联车辆M换道舒适度函数、换道效率函数以及总成本函数;
所述步骤S2中的换道舒适度函数J
其中,w
所述步骤S2中的换道效率函数J
J
其中,w
所述步骤S2中的总成本函数Cost(x
Cost(x
S3、构建智能网联车辆M换道的车辆动力学约束和交通规则约束;
所述步骤S3中的车辆动力学约束和交通规则约束的具体表达式如下:其中,v
S4、通过步骤S2建立的函数与步骤S1建立的轨迹规划方程进行配合,并在步骤S3的约束下,采用通过序列二次方法求解非线性规划问题,计算出最优换道轨迹;
S5、智能网联车辆M执行碰撞检测,判断下一时间步长是否存在碰撞风险;若下一时间步长不存在碰撞风险,则执行步骤S6;若下一时间步长存在碰撞风险,则执行步骤S7;
所述步骤S5碰撞检测的过程具体如下:
S5.1、采用动态矩形对智能网联车辆M进行建模;矩形模型的中心作为智能网联车辆M的偏转中心,偏转中心坐标为(XS5.2、对各个点的坐标进行计算;
S5.3、对智能网联车辆M矩形模型的边框定点进行设置并定义;
S5.4、对智能网联车辆M和原始车道前车A之间的安全约束进行计算;
S5.5、对智能网联车辆M和智能网联车辆M目标车道前车C之间的安全约束进行计算;
S5.6、对智能网联车辆M与智能网联车辆M目标车道后车B之间的安全约束进行计算;
S6、智能网联车辆M以固定时间步长依据最优换道轨迹执行换道并判断换道是否完成,若换道完成,则智能网联车辆M完成车道变更,若换道未完成,则智能网联车辆M以所在位置为起点,执行步骤S1-S4,重新规划最优换道轨迹;
S7、智能网联车辆M以当前位置为起点,执行步骤S1-S4,计算智能网联车辆M返回原始车道的最优换道轨迹,依据返回原始车道的最优换道轨迹返回原始车道。
2.根据权利要求1所述的一种防碰撞的动态智能网联车辆M最优换道轨迹规划方法,其特征在于:所述步骤S5.2的计算公式如下:其中,R表示偏转中心与每个矩形顶点之间的距离,L是智能网联车辆M长度,W是智能网联车辆M宽度,θ(t)表示智能网联车辆M的偏离角,a为矩形模型(X偏转后智能网联车辆M矩形模型的左侧边框为L2,右侧边框为L5,前侧边框为L4,智能网联车辆M原始车道前车A矩形模型的后侧边框为L1,智能网联车辆M目标车道前车C矩形模型的左侧边框为L3,智能网联车辆M目标车道后车B矩形模型的前侧边框为L6,假设偏转后智能网联车辆M矩形模型的左前侧顶点为点1,右前侧顶点为点3,右后侧顶点为点6,偏转后智能网联车辆M原始车道前车A矩形模型的右后侧顶点为点2,偏转后智能网联车辆M目标车道前车C矩形模型的左后侧顶点为点4,偏转后智能网联车辆M目标车道后车B矩形模型的左前侧顶点为点5。
3.根据权利要求2所述的一种防碰撞的动态智能网联车辆M最优换道轨迹规划方法,其特征在于:所述步骤S5.4中的智能网联车辆M和原始车道前车A之间的安全约束表达式如下:其中,X
其中,X
其中X
4.根据权利要求1所述的一种防碰撞的动态智能网联车辆M最优换道轨迹规划方法,其特征在于:所述步骤S5中的碰撞检测存在不满足安全约束的情况下,智能网联车辆M将立即中止换道,并开始规划最优换道轨迹以返回原始车道。