主权项: |
1.一种智能驾驶中安全舒适高效的ACC跟车速度规划方法,其特征在于,包含如下步骤: S1、开始进入ACC跟车逻辑,然后判断自车需要进入的阶段,若是匀速阶段,进入步骤S2,若是加速阶段,进入步骤S3,若是减速阶段,进入步骤S4;其中所述判断的判断条件为: 匀速阶段:|s|ve且(ve^2-vs^2)/(2*b)-ve*(ve-vs)/bmax{0.5s*vs,3m}; 减速阶段:其他情况为减速阶段; 其中,vs为当前时刻的自车速度,ve为当前时刻的前车速度,s为当前时刻的碰撞距离; S2、进入ACC匀速跟车阶段,根据vp和va来控制自车运行;具体包括: S21、判断|s|是否小于0.25s*vs且|vs-ve|<1.5Km/h,若否则进入步骤S22,否则将vp设定为ve,va设定为0来控制自车运行,然后继续运行S1;其中,vp表示自车的期望速度,va表示自车的期望加速度; S22、判断vs≥ve是否成立,若是则进入步骤S23,否则进入步骤S24; S23、判断s是否大于0,若是则将vp设定为ve,va设定为-pow(vs-ve,2)/(2*s),来控制自车运行,然后继续运行S1,若否,则将vp设定为ve-1m/s,va设定为1-pow(vs-ve,2)/(2*s),来控制自车运行,然后继续运行S1;其中,pow(x,y)表示x的y次方; S24、判断s是否大于0,若是则将vp设定为ve+1m/s,va设定为1-pow(vs-ve,2)/(2*s),来控制自车运行,然后继续运行S1,若否,则将vp设定为ve,va设定为-pow(vs-ve,2)/(2*s),来控制自车运行,然后继续运行S1; S3、根据预设的恒定加速度a进行加速,直至加速到vp,然后以预设的恒定加速度b进行减速,直至满足匀速阶段的要求,从而进入匀速阶段;其中|b|<a,vp根据下述公式求出: (vp^2-vs^2)/(2*a)+(ve^2-vp^2)/(2*b)=s+((vp-vs)/a+(ve-vp)/b)*ve; S4、当s≥1时,将vp设定为ve,va设定为b,来控制自车运行,然后继续运行S1;其中,b根据下述任意一个公式求出: (vp^2-vs^2)/(2*b)=s+(vp-vs)/b*ve; b=-pow(vs-ve,2)/(2*s); 当s<-1时,设期望的速度为vp=ve/2,va设定为b,来控制自车运行,然后继续运行S1;其中,b根据下述任意一个公式求出: (vp^2-vs^2)/(2*b)-s=(vp-vs)/b*ve; b=(-pow(vs,2)-pow(ve,2)*3/4+2*ve*vs)/(2*s)。 2.根据权利要求1所述的智能驾驶中安全舒适高效的ACC跟车速度规划方法,其特征在于,步骤S1中,所述判断自车需要进入的阶段的具体执行步骤为: S11、判断自车是否需要进入匀速阶段,若是则进入匀速阶段,若否,则进入步骤S12; S12、判断车辆是否需要进入加速阶段,若是,则进入加速阶段,若否,则进入步骤S13; S13、进入减速阶段。 3.根据权利要求1所述的智能驾驶中安全舒适高效的ACC跟车速度规划方法,其特征在于,步骤S23、步骤S24以及步骤S4中,在计算Va时,若是|s|<1,则将|s|赋值为1后再进行计算。 4.根据权利要求1所述的智能驾驶中安全舒适高效的ACC跟车速度规划方法,其特征在于,若是检测到前车突然急刹车,则控制后车也触发紧急刹车。 5.根据权利要求4所述的智能驾驶中安全舒适高效的ACC跟车速度规划方法,其特征在于,后车紧急刹车时,va的取值根据不同的情况进行区分: 当s
|