1.一种车辆轨迹规划方法,其特征在于,所述方法包括:
获取待规划车辆当前位置的车辆行驶数据以及道路交通数据,以根据所述车辆行驶数据与所述道路交通数据,确定所述待规划车辆是否进行轨迹规划;
若确定所述待规划车辆进行轨迹规划,则基于所述道路交通数据获取所述待规划车辆通过下游路口的理论行驶时间;
根据所述理论行驶时间与所述道路交通数据中的信号灯周期,确定出所述待规划车辆通过交叉口的信号灯周期数量;
基于所述信号灯周期数量与所述待规划车辆的道路交通数据,确定所述待规划车辆预设约束条件的约束范围;
根据所述待规划车辆的预设综合目标函数与所述约束范围,采用预设遗传算法求解所述待规划车辆的预设待优化轨迹曲线模型,若求解获得最优轨迹曲线,则控制所述待规划车辆根据所述最优轨迹曲线进行行驶;
其中,基于所述信号灯周期数量与所述待规划车辆的道路交通数据,确定所述待规划车辆预设约束条件的约束范围之前,所述方法还包括:基于所述待规划车辆的轨迹调整参数,建立所述待规划车辆的待优化轨迹规划曲线模型;其中,所述待优化轨迹规划曲线模型为:;其中, , , , , 表示所述待规划车辆的
轨迹调整参数,表示轨迹规划的开始时刻, 表示轨迹规划的结束时刻, 为位于 与之间的任意时刻, 对应轨迹曲线的总长度, 代表曲线的第一平滑度参数, 代表曲线的第二平滑度参数;
确定与所述待优化轨迹规划曲线模型相对应的所述待规划车辆的加速度模型,以根据所述加速度模型,确定所述待优化轨迹规划曲线模型的平均加速度模型,并基于所述平均加速度模型,建立所述待规划车辆的预设综合目标函数;
根据车辆当前位置的车辆行驶数据以及道路交通数据,建立所述待规划车辆预设约束条件;
根据车辆当前位置的车辆行驶数据以及道路交通数据,建立所述待规划车辆的约束条件具体包括:基于所述轨迹规划的开始时刻与所述轨迹规划的结束时刻,所对应的待优化轨迹规划曲线模型的差值,建立所述待规划车辆的轨迹规划距离约束条件;
获得所述道路交通数据中的下游交叉口绿灯相位起始时间与轨迹规划的开始时刻的第一差值,以及所述道路交通数据中的下游交叉口红灯相位起始时间与轨迹规划的结束时刻的第二差值;
将所述第一差值与信号灯周期的长度的和小于等于所述待规划车辆的行驶时间且所述第二差值与所述信号灯周期的长度的和大于等于所述待规划车辆的行驶时间,作为所述待规划车辆的时间约束条件;
基于所述待优化轨迹规划曲线模型获取速度模型,分别与所述待规划车辆的预设初速度、所述道路交通数据中的道路限速数据,以及所述道路交通数据中的路口限速数据,建立所述待规划车辆不同情况下的限速约束条件;
根据所述加速度模型与所述车辆行驶数据中的最大加速度值与最大减速度值,建立所述待规划车辆的动力学约束条件;
将所述轨迹规划距离约束条件、所述时间约束条件、所述限速约束条件与所述动力学约束条件作为所述待规划车辆的约束条件;
基于所述信号灯周期数量与所述待规划车辆的道路交通数据,确定所述待规划车辆预设约束条件的约束范围,具体包括:将所述待规划车辆的信号灯周期、所述第一差值与所述第二差值输入所述时间约束条件所对应的时间约束公式,以确定所述待规划车辆的轨迹规划的开始时刻与轨迹规划的结束时刻的时间范围;其中,所述时间约束公式为: ,表示所述下游交叉口绿灯相位起始时间与 的相对时间间隔, 表示所述下游交叉口红灯相位起始时间与 的相对时间间隔,C表示信号灯周期的长度;
获取时间范围内所述待规划车辆的轨迹规划距离约束条件、限速约束条件与动力学约束条件,所对应的当前距离约束范围、当前限速约束范围与当前加速度约束范围;
根据所述待规划车辆的预设综合目标函数与所述约束范围,采用预设遗传算法求解所述待规划车辆的预设待优化轨迹曲线模型,具体包括:获取所述待规划车辆的预设综合目标函数;其中,所述预设综合目标函数为:, 为平均加速度值;车辆在两路口间的行驶时间为
,建立的综合效益最优的目标函数为: 其中, 表示无
量纲化的平均加速度,为舒适度的权重系数,为时间的权重系数,t为待规划车辆在两路口间的行驶时间, 为行驶时间t的无量纲化时间;
根据所述约束范围,确定所述待优化轨迹规划曲线模型的轨迹调整参数的范围;
根据所述轨迹调整参数与所述轨迹调整参数的范围,确定待优化轨迹曲线模型的最优解范围;
以所述综合目标函数作为适应度函数,基于预设遗传算法在所述最优解范围内全局搜索最优轨迹调整参数;
若未搜索到所述最优轨迹调整参数,则根据下一信号灯周期的信号灯周期数量求解所述待优化轨迹曲线模型;
若搜索到所述最优轨迹调整参数,则将所述最优轨迹调整参数代入所述待优化轨迹曲线模型,获得所述待规划车辆的最优轨迹。
2.根据权利要求1所述的一种车辆轨迹规划方法,其特征在于,所述获取待规划车辆当前位置的车辆行驶数据以及道路交通数据,以根据所述车辆行驶数据与所述道路交通数据,确定所述待规划车辆是否进行轨迹规划,具体包括:基于预设于所述待规划车辆上的定位系统与传感器设备,获得所述待规划车辆当前位置的车辆行驶数据,并基于预设智能路测设备获取所述待规划车辆当前位置的道路交通数据;其中所述车辆行驶数据包括:行驶路况数据、车辆状态数据;
根据所述行驶路况数据与所述道路交通数据,判断所述待规划车辆当前位置是否处于轨迹规划区;
若是,则根据所述待规划车辆的行驶路况数据、车辆状态数据以及道路交通数据,确定所述待规划车辆的前方路况情况与所述待规划车辆所处路段的路况条件,以根据所述前方路况情况与所述所处路段的路况条件确定所述待规划车辆是否进行轨迹规划。
3.根据权利要求1所述的一种车辆轨迹规划方法,其特征在于,所述基于所述道路交通数据获取所述待规划车辆通过下游路口的理论行驶时间,具体包括:基于所述道路交通数据中的信号配时信息,确定所述待规划车辆的信号灯周期;
根据所述道路交通数据获取所述待规划车辆当前所处交叉口路段的长度,并根据所述道路交通数据获取所述待规划车辆当前道路限速值;
根据所述交叉口路段的长度与所述待规划车辆当前道路限速值,获得所述待规划车辆的理论行驶时间。
4.根据权利要求1所述的一种车辆轨迹规划方法,其特征在于,所述根据所述理论行驶时间与所述道路交通数据中的信号灯周期,确定出所述待规划车辆通过交叉口的信号灯周期数量,具体包括:基于所述信号灯周期确定所述待规划车辆当前信号灯周期内绿灯相位的剩余时间;
若所述剩余时间大于所述理论行驶时间,则确定所述待规划车辆基于当前信号灯周期通过交叉口;
若所述剩余时间小于所述理论行驶时间,则基于所述道路交通数据中的下游交叉口绿灯相位起始时间、下游交叉口红灯相位起始时间与所述信号灯周期,获得所述剩余时间大于所述理论行驶时间时,所述待规划车辆所对应的信号灯周期数量。
5.一种车辆轨迹规划系统,其特征在于,所述系统包括:
第一获取单元,用于获取待规划车辆当前位置的车辆行驶数据以及道路交通数据,以根据所述车辆行驶数据与所述道路交通数据,确定所述待规划车辆是否进行轨迹规划;
第二获取单元,用于若确定所述待规划车辆进行轨迹规划,则基于所述道路交通数据获取所述待规划车辆通过下游路口的理论行驶时间;
第一确定单元,用于根据所述理论行驶时间与所述道路交通数据中的信号灯周期,确定出所述待规划车辆通过交叉口的信号灯周期数量;
第二确定单元,用于基于所述信号灯周期数量与所述待规划车辆的道路交通数据,确定所述待规划车辆预设约束条件的约束范围;
求解单元,用于根据所述待规划车辆的预设综合目标函数与所述约束范围,采用预设遗传算法求解所述待规划车辆的预设待优化轨迹曲线模型,若求解获得最优轨迹曲线,则控制所述待规划车辆根据所述最优轨迹曲线进行行驶;
其中,基于所述信号灯周期数量与所述待规划车辆的道路交通数据,确定所述待规划车辆预设约束条件的约束范围之前,还包括:基于所述待规划车辆的轨迹调整参数,建立所述待规划车辆的待优化轨迹规划曲线模型;其中,所述待优化轨迹规划曲线模型为:;其中, , , , , 表示所述待规划车辆的
轨迹调整参数,表示轨迹规划的开始时刻, 表示轨迹规划的结束时刻, 为位于 与之间的任意时刻, 对应轨迹曲线的总长度, 代表曲线的第一平滑度参数, 代表曲线的第二平滑度参数;
确定与所述待优化轨迹规划曲线模型相对应的所述待规划车辆的加速度模型,以根据所述加速度模型,确定所述待优化轨迹规划曲线模型的平均加速度模型,并基于所述平均加速度模型,建立所述待规划车辆的预设综合目标函数;
根据车辆当前位置的车辆行驶数据以及道路交通数据,建立所述待规划车辆预设约束条件;
根据车辆当前位置的车辆行驶数据以及道路交通数据,建立所述待规划车辆的约束条件具体包括:基于所述轨迹规划的开始时刻与所述轨迹规划的结束时刻,所对应的待优化轨迹规划曲线模型的差值,建立所述待规划车辆的轨迹规划距离约束条件;
获得所述道路交通数据中的下游交叉口绿灯相位起始时间与轨迹规划的开始时刻的第一差值,以及所述道路交通数据中的下游交叉口红灯相位起始时间与轨迹规划的结束时刻的第二差值;
将所述第一差值与信号灯周期的长度的和小于等于所述待规划车辆的行驶时间且所述第二差值与所述信号灯周期的长度的和大于等于所述待规划车辆的行驶时间,作为所述待规划车辆的时间约束条件;
基于所述待优化轨迹规划曲线模型获取速度模型,分别与所述待规划车辆的预设初速度、所述道路交通数据中的道路限速数据,以及所述道路交通数据中的路口限速数据,建立所述待规划车辆不同情况下的限速约束条件;
根据所述加速度模型与所述车辆行驶数据中的最大加速度值与最大减速度值,建立所述待规划车辆的动力学约束条件;
将所述轨迹规划距离约束条件、所述时间约束条件、所述限速约束条件与所述动力学约束条件作为所述待规划车辆的约束条件;
基于所述信号灯周期数量与所述待规划车辆的道路交通数据,确定所述待规划车辆预设约束条件的约束范围,具体包括:将所述待规划车辆的信号灯周期、所述第一差值与所述第二差值输入所述时间约束条件所对应的时间约束公式,以确定所述待规划车辆的轨迹规划的开始时刻与轨迹规划的结束时刻的时间范围;其中,所述时间约束公式为: ,表示所述下游交叉口绿灯相位起始时间与 的相对时间间隔, 表示所述下游交叉口红灯相位起始时间与 的相对时间间隔,C表示信号灯周期的长度;
获取时间范围内所述待规划车辆的轨迹规划距离约束条件、限速约束条件与动力学约束条件,所对应的当前距离约束范围、当前限速约束范围与当前加速度约束范围;
根据所述待规划车辆的预设综合目标函数与所述约束范围,采用预设遗传算法求解所述待规划车辆的预设待优化轨迹曲线模型,具体包括:获取所述待规划车辆的预设综合目标函数;其中,所述预设综合目标函数为:, 为平均加速度值;车辆在两路口间的行驶时间为
,建立的综合效益最优的目标函数为: 其中, 表示无
量纲化的平均加速度,为舒适度的权重系数,为时间的权重系数,t为待规划车辆在两路口间的行驶时间, 为行驶时间t的无量纲化时间;
根据所述约束范围,确定所述待优化轨迹规划曲线模型的轨迹调整参数的范围;
根据所述轨迹调整参数与所述轨迹调整参数的范围,确定待优化轨迹曲线模型的最优解范围;
以所述综合目标函数作为适应度函数,基于预设遗传算法在所述最优解范围内全局搜索最优轨迹调整参数;
若未搜索到所述最优轨迹调整参数,则根据下一信号灯周期的信号灯周期数量求解所述待优化轨迹曲线模型;
若搜索到所述最优轨迹调整参数,则将所述最优轨迹调整参数代入所述待优化轨迹曲线模型,获得所述待规划车辆的最优轨迹。
6.一种车辆轨迹规划设备,其特征在于,所述设备包括:用于存储计算机程序指令的存储器和用于执行程序指令的处理器,其中,当该计算机程序指令被该处理器执行时,触发该设备执行权利要求1‑4中的任一项所述的方法。