自动驾驶车辆的行驶轨迹规划系统及方法与流程

专利2022-06-29  66


本发明涉及一种轨迹规划方法,特别是涉及一种自动驾驶车辆的行驶轨迹规划系统及方法。



背景技术:

近几年自动驾驶汽车的发展蓬勃,许多车厂大量投入资源,各国政府也为自驾时代来临预作准备,例如在欧洲,比利时、法国、意大利与英国等国均计划采用无人驾驶汽车来经营交通运输系统;而在德国、荷兰与西班牙等国,则已允许实验性质的自动驾驶汽车。

自动驾驶汽车使用主动与被动传感器(如光学雷达(lidar)与毫米波雷达(radar))持续做大范围的感测,具有360度视野。在行驶期间自动驾驶汽车需要根据车身与环境动态的参考信息作为系统输入,借此规划出车辆行驶轨迹。

然而,现有自动驾驶汽车在规划行驶轨迹时,仅考虑当前障碍物的位置规划行驶轨迹,然而,若障碍物并非静止物体,如,行人、移动中的车子等,则所规划出的行驶轨迹其精确性及安全性均存在很大的问题。



技术实现要素:

本发明的目的在于提供一种提升轨迹规划的精确性及安全性的自动驾驶车辆的行驶轨迹规划方法。

本发明的自动驾驶车辆的行驶轨迹规划方法,适用于车辆,所述车辆设置有系统,所述系统包括车辆感测装置、障碍物感测装置、轨迹终点运算装置,及电连接所述车辆感测装置、所述障碍物感测装置,及所述轨迹终点运算装置的车用计算机,所述车辆感测装置用于定位所述车辆的当前位置,并用于感测所述车辆的当前航向角、所述车辆的当前速度,及所述车辆的当前加速度,所述障碍物感测装置用于感测与所述车辆相距预定距离范围内的至少一个障碍物,以产生对应于该至少一个障碍物的至少一笔障碍物信息,每笔障碍物信息包括所对应的障碍物的障碍物当前位置,及所对应的障碍物的障碍物移动速度及所对应的障碍物的障碍物加速度,所述轨迹终点运算装置电连接所述车辆感测装置,且存储有相关于所述车辆所行驶的路线的地图,所述地图包含相关于每一条道路的车道数,所述轨迹终点运算装置用于根据所述车辆的所述当前位置及所述地图,估算出多个路径终点,所述方法由所述车用计算机来实施,并包含以下步骤(a)、步骤(b),及步骤(c)。

所述步骤(a)中,所述车用计算机根据所述车辆的所述当前位置、所述车辆的所述当前航向角、所述车辆的所述当前速度、所述车辆的所述当前加速度、所述路径终点、所述当前道路宽度,及所述当前道路曲率产生多个目标轨迹规划结果,每一目标轨迹规划结果包括所述当前位置至所述路径终点的其中一者的轨迹路径,及所述车辆行驶于所述轨迹路径的行驶期间内其在所述轨迹路径的每一位置的速度变化的曲线。

所述步骤(b)中,对于每一障碍物,所述车用计算机根据所述障碍物感测装置产生的所述障碍物信息估算出所述障碍物在所述行驶期间中的多个单位时间点的多个预估移动范围,及多个预估移动速度。

所述步骤(c)中,所述车用计算机根据所述目标轨迹规划结果,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划方法,每笔障碍物信息还包括所对应的障碍物与所述车辆的相对纵向距离、所对应的障碍物与所述车辆的相对纵向速度,及所对应的障碍物与所述车辆的相对纵向加速度,步骤(a)包括以下子步骤:

(a-1)根据所述车辆的所述当前位置、所述车辆的所述当前航向角、所述车辆的所述当前速度、所述车辆的所述当前加速度、所述路径终点、所述当前道路宽度,及所述当前道路曲率产生多个候选轨迹规划结果,每一候选轨迹规划结果包括所述当前位置至所述路径终点的其中所述者的所述轨迹路径及所述车辆行驶于所述轨迹路径的每一位置的所述速度变化的曲线;

(a-2)对于每一候选轨迹规划结果,根据所述候选轨迹规划结果的轨迹路径的轨迹曲率及所述速度变化的曲线获得所述车辆的侧向加速度,且根据该至少一障碍物中位于所述车辆的前方的前方障碍物所对应的障碍物信息的所述相对纵向距离、所述相对纵向速度,及所述相对纵向加速度,获得所述前方障碍物与所述车辆距离发生碰撞的碰撞时间,并根据所述车辆感测装置获得的所述当前速度获得所述车辆将所述当前速度降至零的刹车时间;及

(a-3)根据每一候选轨迹规划结果的所述侧向加速度、所述碰撞时间,及所述刹车时间从所述候选轨迹规划结果中,获得所述目标轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划方法,在子步骤(a-3)中,自所述候选轨迹规划结果所获得的每一目标轨迹规划结果所对应的所述侧向加速度小于等于0.3倍的重力加速度,且所对应的所述碰撞时间大于等于所对应的所述刹车时间。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划方法,步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果的所述速度变化的曲线,获得所述车辆在所述行驶期间内的所述单位时间点的多个车辆速度,及所述车辆在所述单位时间点位于该轨迹路径的多个车辆位置;

(c-2)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果所对应的所述车辆速度与所述车辆位置、每一障碍物的所述预估移动范围,及所述预估移动速度获得意图参数cin,

其中0<αi,t≤1,αi,t为与单位时间点t,及在单位时间点t时的所述车辆位置和第i个障碍物的所述预估移动范围的中心的距离成负相关的变量,为所述车辆在单位时间点t时的车辆位置与第i个障碍物的所述预估移动范围的中心的距离,rh为预定值,为相关于所述车辆在单位时间点t时需要保持的安全距离,与所述车辆在单位时间点t时的车辆速度及所述刹车时间ttb成正相关,当时,时,m为所述单位时间点的总数-1,n为该至少一障碍物的数量;及

(c-3)根据每一个目标轨迹规划结果所对应的所述意图参数cin,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划方法,在步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果获得在所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个侧向位移及所述车辆在所述轨迹路径的每一位置的多个纵向速度;及

(c-2)根据每一个目标轨迹规划结果所对应的所述侧向位移、所述纵向速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划方法,步骤(c-2)包含以下子步骤:

(c-2-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果对应的所述侧向位移及所述纵向速度获得所述目标轨迹规划结果的所述轨迹路径的每一位置的多个轨迹曲率、所述目标轨迹规划结果的所述轨迹路径的每一位置的多个轨迹曲率变化率、所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个加速度、所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个急跳度,及所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个向心加速度;及

(c-2-2)根据每一个目标轨迹规划结果所对应的所述轨迹曲率、所述轨迹曲率变化率、所述加速度、所述急跳度与所述向心加速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划方法,在步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果获得所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个路径长度,及所述车辆自所述目标轨迹规划结果的所述轨迹路径的起点行驶至所述轨迹路径的每一位置的多个行驶时间;及

(c-2)根据每一目标轨迹规划结果所对应的所述路径长度与所述行驶时间,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划方法,在步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果获得所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个速度变化量;

(c-2)根据每一目标轨迹规划结果所对应的所述速度变化量,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

本发明的另一目的在于提供一种提升轨迹规划的精确性及安全性的自动驾驶车辆的行驶轨迹规划系统。

本发明的自动驾驶车辆的行驶轨迹规划系统包含车辆感测装置、障碍物感测装置、轨迹终点运算装置,及电连接所述车辆感测装置、所述障碍物感测装置,及所述轨迹终点运算装置的车用计算机。

所述车辆感测装置用于定位所述车辆的当前位置,并用于感测所述车辆的当前航向角、所述车辆的当前速度,及所述车辆的当前加速度。

所述障碍物感测装置用于感测与所述车辆相距预定距离范围内的至少一个障碍物,以产生对应于该至少一个障碍物的至少一笔障碍物信息,每笔障碍物信息包括所对应的障碍物的障碍物当前位置,及所对应的障碍物的障碍物移动速度及所对应的障碍物的障碍物加速度。

所述轨迹终点运算装置电连接所述车辆感测装置,存储有相关于所述车辆所行驶的路线的地图,所述地图包括相关于每一条道路的车道数,用于根据所述车辆的所述当前位置及所述地图,估算出多个路径终点。

其中,所述车用计算机根据所述车辆的所述当前位置、所述车辆的所述当前航向角、所述车辆的所述当前速度、所述车辆的所述当前加速度、所述路径终点、当前道路宽度,及当前道路曲率产生多个目标轨迹规划结果,每一目标轨迹规划结果包括所述当前位置至所述路径终点的其中一者的轨迹路径,及所述车辆行驶于所述轨迹路径的行驶期间内其在所述轨迹路径的每一位置的速度变化的曲线,对于每一障碍物,所述车用计算机根据所述障碍物感测装置产生的所述障碍物信息估算出所述障碍物在所述行驶期间中的多个单位时间点的多个预估移动范围,及多个预估移动速度,所述车用计算机根据所述目标轨迹规划结果,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划系统,所述障碍物感测装置所产生的每笔障碍物信息还包括所对应的障碍物与所述车辆的相对纵向距离、所对应的障碍物与所述车辆的相对纵向速度,及所对应的障碍物与所述车辆的相对纵向加速度,所述车用计算机根据所述车辆的所述当前位置、所述车辆的所述当前航向角、所述车辆的所述当前速度、所述车辆的所述当前加速度、所述路径终点、所述当前道路宽度,及所述当前道路曲率产生多个候选轨迹规划结果,每一候选轨迹规划结果包括所述当前位置至所述路径终点的其中所述者的所述轨迹路径及所述车辆行驶于所述轨迹路径的每一位置的所述速度变化的曲线,对于每一候选轨迹规划结果,所述车用计算机根据所述候选轨迹规划结果的轨迹路径的轨迹曲率及所述速度变化的曲线获得所述车辆的侧向加速度,且根据该至少一障碍物中位于所述车辆的前方的前方障碍物所对应的障碍物信息的所述相对纵向距离、所述相对纵向速度,及所述相对纵向加速度,获得所述前方障碍物与所述车辆距离发生碰撞的碰撞时间,并根据所述车辆感测装置获得的所述当前速度获得所述车辆将所述当前速度降至零的刹车时间,所述车用计算机根据每一候选轨迹规划结果的所述侧向加速度、所述碰撞时间,及所述刹车时间从所述候选轨迹规划结果中,获得所述目标轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划系统,所述车用计算机自所述候选轨迹规划结果所获得的每一目标轨迹规划结果所对应的该侧向加速度小于等于0.3倍的重力加速度,且所对应的所述碰撞时间大于等于所对应的所述刹车时间。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划系统,对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果的所述速度变化的曲线,获得所述车辆在所述行驶期间内的所述单位时间点的多个车辆速度,及所述车辆在所述单位时间点位于所述轨迹路径的多个车辆位置,对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果所对应的所述车辆速度与所述车辆位置、每一障碍物的所述预估移动范围,及所述预估移动速度获得意图参数cin,

其中0<αi,t≤1,αi,t为与单位时间点t,及在单位时间点t时的所述车辆位置和第i个障碍物的所述预估移动范围的中心的距离成负相关的变量,为所述车辆在单位时间点t时的车辆位置与第i个障碍物的所述预估移动范围的中心的距离,rh为预定值,为相关于所述车辆在单位时间点t时需要保持的安全距离,与所述车辆在单位时间点t时的车辆速度及所述刹车时间ttb成正相关,当时,时,m为所述单位时间点的总数-1,n为该至少一障碍物的数量,所述车用计算机根据每一个目标轨迹规划结果所对应的所述意图参数cin,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划系统,对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果获得在所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个侧向位移及所述车辆在所述轨迹路径的每一位置的多个纵向速度,所述车用计算机根据每一个目标轨迹规划结果所对应的所述侧向位移、所述纵向速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划系统,对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果对应的所述侧向位移及所述纵向速度获得所述轨迹路径的每一位置的多个轨迹曲率、所述轨迹路径的每一位置的多个轨迹曲率变化率、所述车辆行驶于所述轨迹路径的每一位置的多个加速度、所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个急跳度,及所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个向心加速度,所述车用计算机根据每一个目标轨迹规划结果所对应的所述轨迹曲率、所述轨迹曲率变化率、所述加速度、所述急跳度与所述向心加速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划系统,对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果获得所述轨迹路径的每一位置与所述轨迹路径的起点的多个路径长度,及所述车辆自所述目标轨迹规划结果的所述轨迹路径的起点行驶至所述轨迹路径的每一位置的多个行驶时间,所述车用计算机根据每一目标轨迹规划结果所对应的所述路径长度与所述行驶时间,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

较佳地,本发明的自动驾驶车辆的行驶轨迹规划系统,对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果获得所述轨迹路径的每一位置与所述轨迹路径的起点的多个速度变化量,所述车用计算机根据每一目标轨迹规划结果所对应的所述速度变化量,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

本发明的有益效果在于:借由所述车用计算机根据所估算出的每一个障碍物在所述行驶期间中的所述预估移动范围及所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果,借此进一步考虑该至少一障碍物的移动意图区域,以提升轨迹规划的精确性及安全性。

附图说明

本发明的其他的特征及功效,将于参照图式的实施方式中清楚地呈现,其中:

图1是一方块图,说明本发明自动驾驶车辆的行驶轨迹规划系统的一实施例;

图2是一流程图,说明本发明障碍物侦测可信度评估方法的一实施例;

图3是一流程图,辅助图2说明该实施例;

图4是一流程图,辅助图3说明该实施例;及

图5是一示意图,说明多个轨迹路径。

具体实施方式

参阅图1,说明本发明自动驾驶车辆的行驶轨迹规划系统的一实施例,该自动驾驶车辆的行驶轨迹规划系统1设置于一车辆(图未示),该自动驾驶车辆的行驶轨迹规划系统1包括一车辆感测装置11、一障碍物感测装置12、一路况感测装置13、一轨迹终点运算装置14,及一车用计算机15。该车用计算机15电连接该车辆感测装置11、该轨迹终点运算装置14、该障碍物感测装置12,及该路况感测装置13。

该车辆感测装置11用于定位该车辆的一当前位置,并用于感测该车辆的一当前航向角、该车辆的一当前速度,及该车辆的一当前加速度。

该障碍物感测装置12用于感测与该车辆相距一预定距离范围内的至少一个障碍物,以产生对应于该至少一个障碍物的至少一笔障碍物信息,每笔障碍物信息包括所对应的障碍物的障碍物当前位置、所对应的障碍物的障碍物移动速度及所对应的障碍物的障碍物加速度、所对应的障碍物与该车辆的一相对纵向距离、所对应的障碍物与该车辆的一相对纵向速度,及所对应的障碍物与该车辆的一相对纵向加速度。

该路况感测装置13用于感测该车辆所行驶的道路,以获得一当前道路宽度及一当前道路曲率(curvature)。

要特别注意的是,在本实施例中,该车辆感测装置11例如包括一全球定位系统(globalpositioningsystem,gps)、一陀螺仪(gyroscope)、一里程计(odemeter)、一车速计(speedmeter),及一惯性测量单元(inertialmeasurementunit,imu),该障碍物感测装置12及该路况感测装置13例如包括一光学雷达(lidar)、超声波雷达(supersonicwaveradar)、毫米波雷达(millimeterwaveradar)及一相机,获得该当前位置、该当前航向角、该当前速度、该当前加速度、该至少一笔障碍物信息、该当前道路宽度,及该当前道路曲率的方式例如载记于中国台湾专利证书号i453697及i535601中,在此不多加赘述。

该轨迹终点运算装置14电连接该车辆感测装置11,用于估算出多个路径终点。

该车用计算机15存储有一指示出当前的驾驶模式的设置数据。要特别注意的是,该车辆的驾驶者可经由操作电连接该车用计算机15的一输入单元(图未示)设置该设置数据所指示的驾驶模式,在本实施例中,该设置数据所指示的模式有一第一模式、一第二模式,及一第三模式。

在本实施例中,该轨迹终点运算装置14存储有一相关于该车辆所行驶的路线的地图,该地图包含相关于每一条道路的车道数,该轨迹终点运算装置14根据该车辆的该当前位置及该地图,估算出3个路径终点,所述路径终点分别为该车辆在当前车道且在该车辆的该当前位置前方例如20米的一第一路径终点,以及由该第一路径终点向左右两旁车道沿伸的一第二路径终点及一第三路径终点,但不以此限,所述路径终点也可以中国台湾专利证书号i535601中的方式估算出。

参阅图1、图2、图3及图4,说明本发明自动驾驶车辆的行驶轨迹规划系统1如何执行本发明自动驾驶车辆的行驶轨迹规划方法的一实施例,以下详细说明该实施例所包含的步骤。

在步骤202中,在该车用计算机15接收到来自该车辆感测装置11、该路况感测装置13,及该轨迹终点运算装置14的该车辆的该当前位置、该车辆的该当前航向角、该车辆的该当前速度、该车辆的该当前加速度、所述路径终点、该当前道路宽度,及该当前道路曲率后,该车用计算机15根据该车辆的该当前位置、该车辆的该当前航向角、该车辆的该当前速度、该车辆的该当前加速度、所述路径终点、该当前道路宽度,及该当前道路曲率,产生多个候选轨迹规划结果。每一候选轨迹规划结果包括该当前位置至所述路径终点的其中一者的一轨迹路径,及该车辆行驶于该轨迹路径的一行驶期间内其在该轨迹路径的每一位置的一速度变化的曲线,其中每一轨迹路径是对应于其路径终点所在的车道。在本实施例中,该车用计算机15所根据的该当前道路宽度及该当前道路曲率是来自该路况感测装置13,在其他实施方式中,该当前道路宽度及该当前道路曲率也可来自该轨迹终点运算装置14所存储有的该地图。

值得注意的是,每一轨迹路径r(s)可以下式表示

r(s)=[x(s),y(s),θ(s),k(s)]’,

x(s)与y(s)表示该车辆在一xy坐标的坐标位置,

s为该车辆的纵向偏移值,θ(s)为该车辆的航向角,

k(s)为该轨迹路径r(s)的轨迹曲率,

k(s)=a b cs2 ds3

其中,abcd为变量。参阅图5,对于每一轨迹路径r(s)该车用计算机15是利用以下流程来获得该轨迹路径r(s):首先,该车用计算机15根据该至少一笔障碍物信息获得一对应于该轨迹路径r(s)且位于该地图的一目标二维坐标(x*,y*)中的x*值,在本实施例中,该车用计算机15根据该至少一笔障碍物信息判定该轨迹路径r(s)所对应的车道是否有障碍物,若有障碍物,x*值即为该障碍物于该地图的x0值扣除其相关于该车辆与该障碍物须保持的安全距离ro,该安全距离ro与该车辆的当前速度vh及该车辆将该当前速度降至零(即,该车辆刹停)的一刹车时间(timetobrake,ttb)成正相关;若无障碍物,x*值则为一默认值。之后,该车用计算机15根据该轨迹路径r(s)所对应的车道与x*坐标获得对应有y*坐标处于该轨迹路径r(s)所对应的车道的中心的该目标二维坐标(x*,y*),接着,该车用计算机15根据该轨迹路径r(s)所对应的车道及该目标二维坐标(x*,y*)获得一目标曲率k*,最后,将一目标航向角θ*设定为一如,0度的预设角度。一目标点r*即可用该目标二维坐标(x*,y*)、该目标曲率k*,及该目标航向角θ*来表示。接着,该车用计算机15根据该目标点r*利用数值方法求出abcd的近似值,由于本发明的特征并不在于熟知此技艺者所已知的根据该目标点r*利用数值方法(numericalmethod)求出abcd的近似值详细作法载记于“sastrys.s(2012)introductorymethodsofnumericalanalysis”中,为了简洁,故在此省略了他们的细节。每一速度变化的曲线v(s)可以下式表示

v(s)=ρ0 ρ1s ρ2s2 ρ3s3

ρ0=v0,ρ1=a0,

其中,v0为该车辆行驶于所对应的候选轨迹规划结果的该轨迹路径的起点的速度,a0为该车辆行驶于所对应的候选轨迹规划结果的该轨迹路径的起点的加速度,v1为该车辆行驶于所对应的候选轨迹规划结果的该轨迹路径的终点的速度,a1为该车辆行驶于所对应的候选轨迹规划结果的该轨迹路径的终点的加速度,s1为该车辆行驶于所对应的候选轨迹规划结果的该轨迹路径的终点的纵向偏移值。

在步骤203中,对于每一候选轨迹规划结果,该车用计算机15根据该至少一笔障碍物信息,判定该至少一个障碍物中是否存在位于该候选轨迹规划结果的轨迹路径上且位于该车辆的前方的一前方障碍物。当该车用计算机15判定出存在该前方障碍物时,流程进行步骤204;当该车用计算机15判定出不存在该前方障碍物时,流程进行步骤208。

在步骤204中,对于每一对应有该前方障碍物的候选轨迹规划结果,该车用计算机15根据该候选轨迹规划结果的轨迹路径的轨迹曲率k(s)及该速度变化的曲线v(s)获得该车辆的一侧向加速度,其中该侧向加速度为k(s)v2(s),且根据该前方障碍物所对应的障碍物信息的该相对纵向距离、该相对纵向速度,及该相对纵向加速度,获得该前方障碍物与该车辆距离发生碰撞的一碰撞时间(timetocrash,ttc),并根据该车辆感测装置11获得的该当前速度获得该车辆将该当前速度降至零(即,该车辆刹停)的一刹车时间。要特别注意的是,在其他实施方式中,该车用计算机15还根据该至少一障碍物中位于该车辆的后方的一后方障碍物所对应的障碍物信息的该相对纵向距离、该相对纵向速度,及该相对纵向加速度,获得该后方障碍物与该车辆距离发生碰撞的一另一碰撞时间,并根据该车辆感测装置11获得的相关于该后方障碍物的一后方障碍物当前速度,获得该后方障碍物将该后方障碍物当前速度降至零(即,该后方障碍物刹停)的一另一刹车时间。

在步骤205中,对于每一对应有该前方障碍物的候选轨迹规划结果,该车用计算机15根据该候选轨迹规划结果的该侧向加速度、该碰撞时间,及该刹车时间判定是否将该候选轨迹规划结果选为一目标轨迹规划结果。当该车用计算机15判定出将该候选轨迹规划结果选为该目标轨迹规划结果时,流程进行步骤206;当该车用计算机15判定出不将该候选轨迹规划结果选为该目标轨迹规划结果时,流程进行步骤207。值得注意的是,在本实施例中,该车用计算机15是借由判定每一候选轨迹规划结果所对应的该侧向加速度是否小于等于0.3倍的重力加速度(gravitationalacceleration),且所对应的该碰撞时间是否大于等于所对应的该刹车时间,以判定是否将该候选轨迹规划结果选为该目标轨迹规划结果。当该车用计算机15判定出该候选轨迹规划结果的该侧向加速度小于等于0.3倍的重力加速度,且该候选轨迹规划结果的碰撞时间大于等于刹车时间时,则该车用计算机15判定出将该候选轨迹规划结果选为该目标轨迹规划结果;当该车用计算机15判定出该候选轨迹规划结果的该侧向加速度大于0.3倍的重力加速度,或该候选轨迹规划结果的碰撞时间小于刹车时间时,则该车用计算机15判定出不将该候选轨迹规划结果选为该目标轨迹规划结果。在其他该车用计算机15获得该另一碰撞时间的实施方式中,该车用计算机15还判定该候选轨迹规划结果所获得的每一目标轨迹规划结果所对应的该另一碰撞时间是否也大于等于该另一刹车时间。

在步骤206中,对于每一对应有该前方障碍物的候选轨迹规划结果,该车用计算机15将该候选轨迹规划结果选为该目标轨迹规划结果。

在步骤207中,对于每一对应有该前方障碍物的候选轨迹规划结果,该车用计算机15舍弃该候选轨迹规划结果。

在步骤208中,对于每一对应无该前方障碍物的候选轨迹规划结果,该车用计算机15根据该候选轨迹规划结果的轨迹路径的轨迹曲率k(s)及该速度变化的曲线v(s)获得该车辆的一侧向加速度,其中该侧向加速度为k(s)v2(s)。

在步骤209中,对于每一对应无该前方障碍物的候选轨迹规划结果,该车用计算机15根据该候选轨迹规划结果的该侧向加速度判定是否将该候选轨迹规划结果选为一目标轨迹规划结果。当该车用计算机15判定出将该候选轨迹规划结果选为该目标轨迹规划结果时,流程进行步骤210;当该车用计算机15判定出不将该候选轨迹规划结果选为该目标轨迹规划结果时,流程进行步骤211。值得注意的是,在本实施例中,该车用计算机15是借由判定每一候选轨迹规划结果所对应的该侧向加速度是否小于等于0.3倍的重力加速度,以判定是否将该候选轨迹规划结果选为该目标轨迹规划结果。当该车用计算机15判定出该候选轨迹规划结果的该侧向加速度小于等于0.3倍的重力加速度时,则该车用计算机15判定出将该候选轨迹规划结果选为该目标轨迹规划结果;当该车用计算机15判定出该候选轨迹规划结果的该侧向加速度大于0.3倍的重力加速度时,则该车用计算机15判定出不将该候选轨迹规划结果选为该目标轨迹规划结果。

在步骤210中,对于每一对应无该前方障碍物的候选轨迹规划结果,该车用计算机15将该候选轨迹规划结果选为该目标轨迹规划结果。

在步骤211中,对于每一对应无该前方障碍物的候选轨迹规划结果,该车用计算机15舍弃该候选轨迹规划结果。

在步骤206及步骤210后的步骤212中,对于每一障碍物,该车用计算机15根据该障碍物感测装置12产生的该障碍物信息估算出该障碍物在该行驶期间中的多个单位时间点的多个预估移动范围及多个预估移动速度,所述预估移动范围及所述预估移动速度的估算方式例如载记于中国台湾专利证书号i531499中,在此不多加赘述。

在步骤213中,对于每一个目标轨迹规划结果,该车用计算机15根据该目标轨迹规划结果的该速度变化的曲线v(s),获得该车辆在该行驶期间内的所述单位时间点的多个车辆速度,及该车辆在所述单位时间点位于该轨迹路径的多个车辆位置。

在步骤214中,对于每一个目标轨迹规划结果,该车用计算机15根据该目标轨迹规划结果所对应的所述车辆速度与所述车辆位置、每一障碍物的所述预估移动范围,及所述预估移动速度获得一意图参数cin,

其中0<αi,t≤1,αi,t为与单位时间点t,及在单位时间点t时的该车辆位置和第i个障碍物的该预估移动范围的中心的距离成负相关的一变量(即,αi,t不仅与单位时间点t负相关,还与在单位时间点t时的该车辆位置和第i个障碍物的该预估移动范围的中心的距离负相关),为该车辆在单位时间点t时的车辆位置与第i个障碍物的该预估移动范围的中心的距离,rh为一预定值,为相关于该车辆在单位时间点t时需要保持的安全距离,与该车辆在单位时间点t时的该车辆速度及该刹车时间ttb成正相关(即,不仅与该速度正相关,还与该刹车时间ttb正相关),当时,时,m为所述单位时间点的总数-1,n为该至少一障碍物的数量。值得注意的是,在本实施例中,但不以此为限。

在步骤215中,该车用计算机15判定所存储的该设置数据所指示的驾驶模式。当该车用计算机15判定出该设置数据指示出的驾驶模式为该第一模式时,进行步骤216;当该车用计算机15判定出该设置数据指示出的驾驶模式为该第二模式时,进行步骤220;当该车用计算机15判定出该设置数据指示出的驾驶模式为该第三模式时,进行步骤223。

在步骤216中,对于每一个目标轨迹规划结果,该车用计算机15根据该目标轨迹规划结果获得在该车辆行驶于该目标轨迹规划结果的该轨迹路径的每一位置与该轨迹路径的起点的多个侧向位移及该车辆在该轨迹路径的每一位置的多个纵向速度。

在步骤217中,对于每一个目标轨迹规划结果,该车用计算机15根据该目标轨迹规划结果对应的所述侧向位移及所述纵向速度获得该目标轨迹规划结果的该轨迹路径的每一位置的多个轨迹曲率ki、该目标轨迹规划结果的该轨迹路径的每一位置的多个轨迹曲率变化率(rateofchangeofcurvature)、该车辆行驶于该目标轨迹规划结果的该轨迹路径的每一位置的多个加速度ai、该车辆行驶于该目标轨迹规划结果的该轨迹路径的每一位置的多个急跳度(jerk)ji,及该车辆行驶于该目标轨迹规划结果的该轨迹路径的每一位置的多个向心加速度其中i=[0,p],p为该轨迹路径的位置总数量减一,vi为该车辆行驶于该目标轨迹规划结果的该轨迹路径的每一位置的多个速度。

在步骤218中,根据每一个目标轨迹规划结果所对应的所述轨迹曲率ki、所述轨迹曲率变化率所述加速度ai、所述急跳度ji与所述向心加速度获得一轨迹曲率参数ck、一轨迹曲率变化率参数cdk、一急跳度参数cj,及一向心加速度参数cca,

在步骤219中,该车用计算机15根据每一个目标轨迹规划结果所对应的该意图参数cin、该向心加速度获得轨迹曲率参数ck、该轨迹曲率变化率参数cdk、该急跳度参数cj,及该向心加速度参数cca,从所述目标轨迹规划结果决定出一最佳轨迹规划结果。在本实施例中,该最佳轨迹规划结果为该意图参数cin、该向心加速度获得轨迹曲率参数ck、该轨迹曲率变化率参数cdk、该急跳度参数cj,及该向心加速度参数cca的和为最低者。

值得注意的是,在该第一模式下所决定出的该最佳轨迹规划结果有相对较小的曲率、加速度、急跳度与向心加速度,因此在该第一模式是以舒适度作为考虑决定出的该最佳轨迹规划结果。

在步骤215后的步骤220中,对于每一个目标轨迹规划结果,该车用计算机15根据该目标轨迹规划结果获得该目标轨迹规划结果的该轨迹路径的每一位置与该轨迹路径的起点的多个路径长度li,及该车辆自该目标轨迹规划结果的该轨迹路径的起点行驶至该轨迹路径的每一位置的多个行驶时间ti。

在步骤221中,对于每一个目标轨迹规划结果,该车用计算机15根据所述路径长度li及所述行驶时间ti,获得一路径长度参数cl及一行驶时间参数ct,

在步骤222中,该车用计算机15根据每一个目标轨迹规划结果所对应的该意图参数cin、该路径长度参数cl,及该行驶时间参数ct,从所述目标轨迹规划结果决定出一最佳轨迹规划结果。在本实施例中,该最佳轨迹规划结果为该意图参数cin、该路径长度参数cl,及该行驶时间参数ct的和为最低者。

值得注意的是,在该第二模式下所决定出的该最佳轨迹规划结果有相对较小的路径长度与行驶时间,因此在该第二模式是以效率作为考虑决定出的该最佳轨迹规划结果。

在步骤215后的步骤223中,对于每一个目标轨迹规划结果,该车用计算机15根据该目标轨迹规划结果获得该目标轨迹规划结果的该轨迹路径的每一位置与该轨迹路径的起点的多个速度变化量△vi。

在步骤224中,该车用计算机15根据每一目标轨迹规划结果所对应的所述速度变化量△vi,获得一速度参数ce,

在步骤225中,该车用计算机15根据每一个目标轨迹规划结果所对应的该意图参数cin及该速度参数ce,从所述目标轨迹规划结果决定出一最佳轨迹规划结果。

值得注意的是,在该第三模式下所决定出的该最佳轨迹规划结果有相对较低的速度,因此在该第三模式是以节能作为考虑决定出的该最佳轨迹规划结果。

综上所述,本发明自动驾驶车辆的行驶轨迹规划系统及方法,借由该车用计算机15根据所估算出的每一个障碍物在该行驶期间中的所述预估移动范围及所述预估移动速度,从所述目标轨迹规划结果决定出一最佳轨迹规划结果,考虑该至少一障碍物的移动意图区域,以提升轨迹规划的精确性及安全性,此外,能根据驾驶的需求动态调整该设置数据,以在不同的驾驶模式下驾驶该车辆,故确实能达成本发明的目的。

以上所述者,仅为本发明的实施例而已,当不能以此限定本发明实施的范围,即凡依本发明权利要求书及说明书内容所作的简单的等效变化与修饰,皆仍属本发明的范围。


技术特征:

1.一种自动驾驶车辆的行驶轨迹规划方法,适用于车辆,所述车辆设置有系统,所述系统包括车辆感测装置、障碍物感测装置、轨迹终点运算装置,及电连接所述车辆感测装置、所述障碍物感测装置,及所述轨迹终点运算装置的车用计算机,所述车辆感测装置用于定位所述车辆的当前位置,并用于感测所述车辆的当前航向角、所述车辆的当前速度,及所述车辆的当前加速度,所述障碍物感测装置用于感测与所述车辆相距预定距离范围内的至少一个障碍物,以产生对应于该至少一个障碍物的至少一笔障碍物信息,每笔障碍物信息包括所对应的障碍物的障碍物当前位置,及所对应的障碍物的障碍物移动速度及所对应的障碍物的障碍物加速度,所述轨迹终点运算装置电连接所述车辆感测装置,且存储有相关于所述车辆所行驶的路线的地图,所述地图包括相关于每一条道路的车道数,所述轨迹终点运算装置用于根据所述车辆的所述当前位置及所述地图,估算出多个路径终点,所述自动驾驶车辆的行驶轨迹规划方法由所述车用计算机来实施,其特征在于:所述方法包含以下步骤:

(a)根据所述车辆的所述当前位置、所述车辆的所述当前航向角、所述车辆的所述当前速度、所述车辆的所述当前加速度、所述路径终点、当前道路宽度,及当前道路曲率产生多个目标轨迹规划结果,每一目标轨迹规划结果包括所述当前位置至所述路径终点的其中一者的轨迹路径,及所述车辆行驶于所述轨迹路径的行驶期间内其在所述轨迹路径的每一位置的速度变化的曲线;

(b)对于每一障碍物,根据所述障碍物感测装置产生的所述障碍物信息估算出所述障碍物在所述行驶期间中的多个单位时间点的多个预估移动范围,及多个预估移动速度;及

(c)根据所述目标轨迹规划结果,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

2.根据权利要求1所述的自动驾驶车辆的行驶轨迹规划方法,其特征在于:每笔障碍物信息还包括所对应的障碍物与所述车辆的相对纵向距离、所对应的障碍物与所述车辆的相对纵向速度,及所对应的障碍物与所述车辆的相对纵向加速度,步骤(a)包括以下子步骤:

(a-1)根据所述车辆的所述当前位置、所述车辆的所述当前航向角、该所述车辆的该所述当前速度、所述车辆的所述当前加速度、所述路径终点、所述当前道路宽度,及所述当前道路曲率产生多个候选轨迹规划结果,每一候选轨迹规划结果包括所述当前位置至所述路径终点的其中所述者的所述轨迹路径及所述车辆行驶于所述轨迹路径的每一位置的所述速度变化的曲线;

(a-2)对于每一候选轨迹规划结果,根据所述候选轨迹规划结果的轨迹路径的轨迹曲率及所述速度变化的曲线获得所述车辆的侧向加速度,且根据该至少一障碍物中位于所述车辆的前方的前方障碍物所对应的障碍物信息的所述相对纵向距离、所述相对纵向速度,及所述相对纵向加速度,获得所述前方障碍物与所述车辆距离发生碰撞的碰撞时间,并根据所述车辆感测装置获得的所述当前速度获得所述车辆将所述当前速度降至零的刹车时间;及

(a-3)根据每一候选轨迹规划结果的所述侧向加速度、所述碰撞时间,及所述刹车时间从所述候选轨迹规划结果中,获得所述目标轨迹规划结果。

3.根据权利要求2所述的自动驾驶车辆的行驶轨迹规划方法,其特征在于:在子步骤(a-3)中,自所述候选轨迹规划结果所获得的每一目标轨迹规划结果所对应的所述侧向加速度小于等于0.3倍的重力加速度,且所对应的所述碰撞时间大于等于所对应的所述刹车时间。

4.根据权利要求2所述的自动驾驶车辆的行驶轨迹规划方法,其特征在于:步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果的所述速度变化的曲线,获得所述车辆在所述行驶期间内的所述单位时间点的多个车辆速度,及所述车辆在所述单位时间点位于该轨迹路径的多个车辆位置;

(c-2)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果所对应的所述车辆速度与所述车辆位置、每一障碍物的所述预估移动范围,及所述预估移动速度获得意图参数cin,

其中0<αi,t≤1,αi,t为与单位时间点t,及在单位时间点t时的所述车辆位置和第i个障碍物的所述预估移动范围的中心的距离成负相关的变量,为所述车辆在单位时间点t时的车辆位置与第i个障碍物的所述预估移动范围的中心的距离,rh为预定值,为相关于所述车辆在单位时间点t时需要保持的安全距离,与所述车辆在单位时间点t时的车辆速度及所述刹车时间ttb成正相关,当时,时,m为所述单位时间点的总数-1,n为该至少一障碍物的数量;及

(c-3)根据每一个目标轨迹规划结果所对应的所述意图参数cin,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

5.根据权利要求1所述的自动驾驶车辆的行驶轨迹规划方法,其特征在于:在步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果获得在所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个侧向位移及所述车辆在所述轨迹路径的每一位置的多个纵向速度;及

(c-2)根据每一个目标轨迹规划结果所对应的所述侧向位移、所述纵向速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

6.根据权利要求5所述的自动驾驶车辆的行驶轨迹规划方法,其特征在于:步骤(c-2)包含以下子步骤:

(c-2-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果对应的所述侧向位移及所述纵向速度获得所述目标轨迹规划结果的所述轨迹路径的每一位置的多个轨迹曲率、所述目标轨迹规划结果的所述轨迹路径的每一位置的多个轨迹曲率变化率、所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个加速度、所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个急跳度,及所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个向心加速度;及

(c-2-2)根据每一个目标轨迹规划结果所对应的所述轨迹曲率、所述轨迹曲率变化率、所述加速度、所述急跳度与所述向心加速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

7.根据权利要求1所述的自动驾驶车辆的行驶轨迹规划方法,其特征在于:在步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果获得所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个路径长度,及所述车辆自所述目标轨迹规划结果的所述轨迹路径的起点行驶至所述轨迹路径的每一位置的多个行驶时间;及

(c-2)根据每一目标轨迹规划结果所对应的所述路径长度与所述行驶时间,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

8.根据权利要求1所述的自动驾驶车辆的行驶轨迹规划方法,其特征在于:在步骤(c)包括以下子步骤:

(c-1)对于每一个目标轨迹规划结果,根据所述目标轨迹规划结果获得所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个速度变化量;

(c-2)根据每一目标轨迹规划结果所对应的所述速度变化量,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

9.一种自动驾驶车辆的行驶轨迹规划系统,适用于车辆,其特征在于:该自动驾驶车辆的行驶轨迹规划系统包含:

车辆感测装置,用于定位所述车辆的当前位置,并用于感测所述车辆的当前航向角、所述车辆的当前速度,及所述车辆的当前加速度;

障碍物感测装置,用于感测与所述车辆相距预定距离范围内的至少一个障碍物,以产生对应于该至少一个障碍物的至少一笔障碍物信息,每笔障碍物信息包括所对应的障碍物的障碍物当前位置,及所对应的障碍物的障碍物移动速度及所对应的障碍物的障碍物加速度;

轨迹终点运算装置,电连接所述车辆感测装置,存储有相关于所述车辆所行驶的路线的地图,所述地图包括相关于每一条道路的车道数,用于根据所述车辆的所述当前位置及所述地图,估算出多个路径终点;及

车用计算机,电连接所述车辆感测装置、所述障碍物感测装置,及所述轨迹终点运算装置;

其中,所述车用计算机根据所述车辆的所述当前位置、所述车辆的所述当前航向角、所述车辆的所述当前速度、所述车辆的所述当前加速度、所述路径终点、当前道路宽度,及当前道路曲率产生多个目标轨迹规划结果,每一目标轨迹规划结果包括所述当前位置至所述路径终点的其中一者的轨迹路径,及所述车辆行驶于所述轨迹路径的行驶期间内其在所述轨迹路径的每一位置的速度变化的曲线,对于每一障碍物,所述车用计算机根据所述障碍物感测装置产生的所述障碍物信息估算出所述障碍物在所述行驶期间中的多个单位时间点的多个预估移动范围,及多个预估移动速度,所述车用计算机根据所述目标轨迹规划结果,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

10.根据权利要求9所述的自动驾驶车辆的行驶轨迹规划系统,其特征在于:所述障碍物感测装置所产生的每笔障碍物信息还包括所对应的障碍物与所述车辆的相对纵向距离、所对应的障碍物与所述车辆的相对纵向速度,及所对应的障碍物与所述车辆的相对纵向加速度,所述车用计算机根据所述车辆的所述当前位置、所述车辆的所述当前航向角、所述车辆的所述当前速度、所述车辆的所述当前加速度、所述路径终点、所述当前道路宽度,及所述当前道路曲率产生多个候选轨迹规划结果,每一候选轨迹规划结果包括所述当前位置至所述路径终点的其中所述者的所述轨迹路径及所述车辆行驶于所述轨迹路径的每一位置的所述速度变化的曲线,对于每一候选轨迹规划结果,所述车用计算机根据所述候选轨迹规划结果的轨迹路径的轨迹曲率及所述速度变化的曲线获得所述车辆的侧向加速度,且根据该至少一障碍物中位于所述车辆的前方的前方障碍物所对应的障碍物信息的所述相对纵向距离、所述相对纵向速度,及所述相对纵向加速度,获得所述前方障碍物与所述车辆距离发生碰撞的碰撞时间,并根据所述车辆感测装置获得的所述当前速度获得所述车辆将所述当前速度降至零的刹车时间,所述车用计算机根据每一候选轨迹规划结果的所述侧向加速度、所述碰撞时间,及所述刹车时间从所述候选轨迹规划结果中,获得所述目标轨迹规划结果。

11.根据权利要求10所述的自动驾驶车辆的行驶轨迹规划系统,其特征在于:所述车用计算机自所述候选轨迹规划结果所获得的每一目标轨迹规划结果所对应的该侧向加速度小于等于0.3倍的重力加速度,且所对应的所述碰撞时间大于等于所对应的所述刹车时间。

12.根据权利要求10所述的自动驾驶车辆的行驶轨迹规划系统,其特征在于:对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果的所述速度变化的曲线,获得所述车辆在所述行驶期间内的所述单位时间点的多个车辆速度,及所述车辆在所述单位时间点位于所述轨迹路径的多个车辆位置,对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果所对应的所述车辆速度与所述车辆位置、每一障碍物的所述预估移动范围,及所述预估移动速度获得意图参数cin,

其中0<αi,t≤1,αi,t为与单位时间点t,及在单位时间点t时的所述车辆位置和第i个障碍物的所述预估移动范围的中心的距离成负相关的变量,为所述车辆在单位时间点t时的车辆位置与第i个障碍物的所述预估移动范围的中心的距离,rh为预定值,为相关于所述车辆在单位时间点t时需要保持的安全距离,与所述车辆在单位时间点t时的车辆速度及所述刹车时间ttb成正相关,当时,时,m为所述单位时间点的总数-1,n为该至少一障碍物的数量,所述车用计算机根据每一个目标轨迹规划结果所对应的所述意图参数cin,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

13.根据权利要求9所述的自动驾驶车辆的行驶轨迹规划系统,其特征在于:对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果获得在所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置与所述轨迹路径的起点的多个侧向位移及所述车辆在所述轨迹路径的每一位置的多个纵向速度,所述车用计算机根据每一个目标轨迹规划结果所对应的所述侧向位移、所述纵向速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

14.根据权利要求13所述的自动驾驶车辆的行驶轨迹规划系统,其特征在于:对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果对应的所述侧向位移及所述纵向速度获得所述轨迹路径的每一位置的多个轨迹曲率、所述轨迹路径的每一位置的多个轨迹曲率变化率、所述车辆行驶于所述轨迹路径的每一位置的多个加速度、所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个急跳度,及所述车辆行驶于所述目标轨迹规划结果的所述轨迹路径的每一位置的多个向心加速度,所述车用计算机根据每一个目标轨迹规划结果所对应的所述轨迹曲率、所述轨迹曲率变化率、所述加速度、所述急跳度与所述向心加速度,以及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出所述最佳轨迹规划结果。

15.根据权利要求9所述的自动驾驶车辆的行驶轨迹规划系统,其特征在于:对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果获得所述轨迹路径的每一位置与所述轨迹路径的起点的多个路径长度,及所述车辆自所述目标轨迹规划结果的所述轨迹路径的起点行驶至所述轨迹路径的每一位置的多个行驶时间,所述车用计算机根据每一目标轨迹规划结果所对应的所述路径长度与所述行驶时间,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

16.根据权利要求9所述的自动驾驶车辆的行驶轨迹规划系统,其特征在于:对于每一个目标轨迹规划结果,所述车用计算机根据所述目标轨迹规划结果获得所述轨迹路径的每一位置与所述轨迹路径的起点的多个速度变化量,所述车用计算机根据每一目标轨迹规划结果所对应的所述速度变化量,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。

技术总结
一种自动驾驶车辆的行驶轨迹规划系统及方法,该方法适用于车辆,由车用计算机来实施,并包含:(A)根据所述车辆的当前位置、当前航向角、当前速度、当前加速度、多个路径终点、当前道路宽度,及当前道路曲率产生多个目标轨迹规划结果,每一目标轨迹规划结果包括轨迹路径,及速度变化的曲线;(B)估算出与所述车辆相距预定距离范围内的每一障碍物在行驶期间中的多个单位时间点的多个预估移动范围及多个预估移动速度;及(C)根据所述目标轨迹规划结果,及每一障碍物的所述预估移动范围与所述预估移动速度,从所述目标轨迹规划结果决定出最佳轨迹规划结果。借此进一步考虑每一障碍物的移动意图区域,以提升轨迹规划的精确性及安全性。

技术研发人员:林伯翰;许琮明;张志豪;郭宜钧
受保护的技术使用者:财团法人车辆研究测试中心
技术研发日:2018.12.27
技术公布日:2020.06.09

转载请注明原文地址: https://bbs.8miu.com/read-32086.html

最新回复(0)