1.一种自动驾驶下交叉口通行权设置方法,其特征在于,该方法包括如下步骤:
步骤1:确定交叉口各进口道、出口道车道数并分别对其编号,将交叉口的内部空间分为若干正方形的小方格并将方格进行编号,确定各方格的坐标范围;采集车辆所在进口道编号,转弯方向,到达停车线的预测时刻,输入交叉口所有的车辆通行路径压到的方格以及车辆进入和驶出方格的位置点;
步骤2:建立车辆行驶路径选择模型,建立车辆实际到达停车线时刻的计算模型,建立驶入方格的时刻和驶出方格的时刻的计算模型;
步骤3:确保同一个方格在同一时刻只能被一辆车占用,建立多台车辆占用同一个方格的约束条件公式;
步骤4:以交叉口到达车辆的总延误最小为目标函数,优化获得每辆车的最佳出口车道以及通过交叉口的最佳时刻;
所述步骤1包括如下步骤:
步骤11:用参数O表示交叉口进口道,参数D表示交叉口出口道,参数E,W,S,N分别表示东、西、南、北方向,O∈{E,W,S,N},D∈{E,W,S,N};g表示车道上的第g辆车;Oi→Dj表示车辆从O进口道的第i条车道驶向D出口道的第j条车道,不考虑掉头行驶,因此,在Oi→Dj中,O≠D;每个进口道包含iO条车道,其中iO∈{1,2,…,nO},nO表示O方向进口道最大车道数,每个出口道包含jD条车道,其中jD∈{1,2,…,mD},mD表示D方向出口道最大车道数;车速用参数v表示,考虑车辆在交叉口内部匀速行驶,不能停留;将交叉口分为若干正方形的小方格并进行编号,Rpq表示方格R在x轴和y轴对应的编号分别是p,q;建立直角坐标系,采集每辆车压过的方格及进入和驶出方格的位置点, 表示路径Oi→Dj上的车辆进入第a个方格Rpq的位置点,则 其中a∈{1,2,…,A},A表示进入位置点的总数;
表示路径Oi→Dj驶出第b个方格Rpq的位置点, 其中b∈{1,
2,…,B},B表示驶出位置点的总数;
所述步骤2中,建立车辆行驶路径选择模型,建立车辆实际到达停车线时刻的计算模型,建立驶入方格的时刻和驶出方格的时刻的计算模型,包括如下步骤:步骤21:进口道车辆左转和右转,驶出交叉口的方向已知且确定,因此在驶出方向的所有出口道选择一条车道驶出,由公式(1)计算;
公式中, 为二元变量, 表示第g辆车选择路径Oi→Dj,即从O方向的第i条进口道行驶到D方向的第j条出口道; 表示车辆不从第j条出口道驶出;
当车辆为直行且进口道iO小于等于出口道车道数jD,即iO≤jD时,直行车辆选择的路径由公式(2)计算:当车辆为直行且进口道iO大于出口道jD即iO>jD时,进口道比出口道多出的车道上的车辆驶向距离最近的出口道,路径选择由公式(3)计算:步骤22:O方向的第i条进口道上的第g辆车预测到达停车线的时刻用 表示,到达停车线的实际时刻用 表示,驶离停车线,进入交叉口的时刻用 表示;
第g辆车到达停车线的预测时刻大于等于前一辆车g-1驶离停车线的时刻,即则不用排队等待;若 时,则第g辆车不能按预测时刻到达停车线,需要排队等待,则到达停车线的实际时刻 由公式(4)计算;
公式中dv为车辆到交叉口停车线的距离,GOi表示一条进口道上的车辆总数;
当g=1时,即车辆为车道第一辆车时,前方没有等待通行的车辆,此时实际到达停车线的时刻等于预测到达停车线时刻,由公式(5)计算;
步骤23:第g辆车驶入位置点 的时刻用 表示,驶出位置点 的时刻用
表示,驶入第一个位置点的时刻等于车辆离开停车线的时刻,由公式(6)计算:
第g辆车驶入其他位置点的时刻由公式(7)计算:
第g辆车驶出第一个位置点的时刻由公式(8)计算:
第g辆车驶出其他位置点的时刻由公式(9)计算:
2.根据权利要求1所述的一种自动驾驶下交叉口通行权设置方法,其特征在于,所述步骤3中,确保同一个方格在同一时刻只能被一辆车占用,建立多台车辆占用同一个方格的约束条件公式,包括如下步骤:步骤31:会存在多条不同行驶路径的车辆到达同一个方格Rpq,须两两比较车辆到达和驶出方格的时刻,定义到达交叉口所有车辆的集合为G,对于任意一辆车g1,g2∈G,假设车辆g1的路径为(Oi→Dj)1,车辆g2的路径为(Oi→Dj)2,对任意的O∈{E,W,S,N},D∈{E,W,S,N},i∈{1,2,…,nO},j∈{1,2,…,mD};使用公式(10)和公式(11)可以确保同一个方格在同一时刻只能被一辆车占用;
公式中 为二元变量,当方格Rpq在路径Oi→Dj上时, 当方格Rab不在路径Oi→Dj上时, M为大的正数,y为二元变量,可取值为0或1。
3.根据权利要求2所述的一种自动驾驶下交叉口通行权设置方法,其特征在于,所述步骤4中,以交叉口到达车辆的总延误最小为目标函数,优化获得每辆车的最佳出口车道以及通过交叉口的最佳时刻,包括如下步骤:步骤41:第g辆车的延误由公式(12)计算,延误等于驶离停车线的时刻减去预测到达停车线的时刻;总延误由公式(13)计算,根据总延误最小的公式(14),及公式 (1)-(13)可以确定每辆车在交叉口区域内的最佳路径 即最佳出口车道,和驶离停车线最优时刻MIN(Delay) (14)。