1.一种考虑邻车切入风险的轨迹规划方法,其特征在于,步骤如下:步骤1)、车载传感器获取自车纵向位置、纵向速度、纵向加速度、横向位置、横向速度、横向加速度和邻车的纵向位置、纵向速度、纵向加速度、横向位置、横向速度、横向加速度信息;
步骤2)、根据步骤1)中得到的自车纵向位置、纵向速度、纵向加速度、横向位置、横向速度、横向加速度和邻车的纵向位置、纵向速度、纵向加速度、横向位置、横向速度、横向加速度信息,建立自车的纵横向风险评估模型为:R=R
式中,R为自车的纵横向风险;R
自车与邻车的碰撞风险为:
式中,γ为常参数一,λ为常参数二,通过实验确定;
式中,M为自车的等效质量;m为自车真实质量;
自车与道路边界的碰撞风险为:
式中,η为影响因子;y
步骤3)、沿纵向和横向采样多个轨迹终点,根据当前时刻车辆位置、速度、加速度和轨迹终点,规划多条不同的候选轨迹;
沿纵向和横向采样多个轨迹终点具体为:沿纵向分别按如下纵向位置采样:式中,x
沿横向按如下横向位置采样:
式中,y
根据纵向位置
规划多条不同的轨迹具体为:采用如下五次多项式规划轨迹:式中,τ为轨迹,τ∈{ij},i=1,2,...,5,j=1,2,...,5,轨迹τ对应不同的轨迹终点;x步骤4)、根据步骤2)中建立的纵横向风险评估模型,评价步骤3)中得到的多条不同的轨迹的风险,选择风险最小的轨迹作为最终轨迹;
评价步骤3)中得到的多条不同的轨迹的风险具体为:求解轨迹τ的风险: