1.一种自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,包括:S1、获取自动驾驶汽车的待跟随预期速度方案,并根据所述待跟随预期速度方案选取预瞄目标;
S2、根据所述预瞄目标的预瞄路径点更新待跟随位姿列表;
S3、将所述待跟随位姿列表中的路点插入跟随路点列表中并删除,同时计算所述跟随路点列表的首末里程差,当所述首末里程差超过预设的最短行走距离时,停止插入;
S4、基于当前跟随路点列表进行预瞄,若预瞄结果不满足预设精度,则触发重新预瞄规划并将所述预瞄结果插入转弯半径-里程列表,返回S3;若所述预瞄结果满足预设精度,则直接返回S3;
S5、重复S3-S4,直至所述待跟随位姿列表为空,输出所述转弯半径-里程列表;
S6、基于所述自动驾驶汽车的当前行驶信息和转弯半径-里程列表,计算预期侧向加速度并发送给所述自动驾驶汽车进行跟随控制。
2.根据权利要求1所述的自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,所述S1中,获取所述自动驾驶汽车的待跟随预期速度方案,并根据所述待跟随预期速度方案选取预瞄目标包括:获取跟随路径信息,以及所述自动驾驶汽车的当前车辆状态;
将所述当前车辆状态转换到与跟随路径相同的坐标系下,获取所述预瞄目标的里程范围。
3.根据权利要求1所述的自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,所述S4中,进行预瞄包括:构建双圆弧多段轨迹计算模型,基于轨迹形状自由变量θ对所述双圆弧多段轨迹计算模型求解,获取双圆弧多段轨迹,其中,所述轨迹形状自由变量θ通过目标函数确定。
4.根据权利要求3所述的自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,所述双圆弧多段轨迹计算模型为:J=A+R1(N1-V);
CA=A+R1N1;
CB=J+R2V;
其中,A为起点位置,θA为起点方向,B为终点,θB为终点方向,α为θA指向AB的角度,β为AB指向θB的角度,θ为第一段圆弧转过的角度,N1为A点的法向量,V为J点的法向量,R1为第一段圆弧的半径,R2为第二段圆弧的半径,CA、CB为两圆弧的圆心。
5.根据权利要求4所述的自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,所述目标函数为:L1≥Lmin;
L2≥Lmin;
其中,wd为横向偏差的权重,d为预瞄偏差,wR为曲率权重,κmin为最小曲率,κmax为最大曲率,L1为第一段圆弧长度,L2为第二段圆弧长度,Lmin为最小距离。
6.根据权利要求1所述的自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,所述S4中,触发所述重新预瞄规划通过预设的触发机制判定,所述触发机制根据跟随偏差和执行里程构建,所述触发机制为:其中,se为主车当前里程,de为路径跟随偏差,dmax为容许最大路径跟随偏差,smax为最大执行里程,e为触发结果。
7.根据权利要求1所述的自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,所述S4中,触发重新预瞄规划并将所述预瞄结果插入转弯半径-里程列表后,将当前跟随路点列表中除最后两个路点外的其他路点删除,获取新的跟随路点列表,返回所述S3。
8.根据权利要求1所述的自动驾驶汽车路径跟随的事件触发预瞄决策方法,其特征在于,所述S6中,计算所述预期侧向加速度包括:其中,ay为侧向加速度,V为当前车速,Rn为转弯半径。