(左转道，右转道和直行道)，从而为无人地面车辆在进入路口前选择合适的车道提供依据。当车辆驶入路口时，根据交通规则车辆需要提前一定的距离进入相应的车道来等候交通灯。有人车辆通过驾驶员观察每条车道上的导向箭头来选择合适的车道，而无人地面车辆经常会由于车辆遮挡、天气等原因无法准确检测导向箭头，从而无法提前进入正确的车道。这时该属性的加入能为无人地面车辆提前提供导向箭头信息，无人地面车辆因此能够提前做出选择，进入正确的车道；
[0034](7)路口距离属性给出当前路段的斑马线外沿至路口中心节点的距离值，用以辅助完成双线路口模型的建立，使得无人地面车辆能够精确获得路口的驶入点坐标和驶出点坐标。
[0035]本发明所述的带有路口距离属性的双线路口模型能够在不影响其他方向的通行条件下禁止该方向上的车辆直行、右转、左转，在正确表达城市交通的实际规则下，同时考虑了无人地面车辆的运动特性，对车辆在转弯时的轨迹进行了圆滑处理(将直角转向变为圆弧转向)，并通过提前存储的斑马线至道路中心点的距离信息来辅助无人地面车辆对路口的识别。同时设定了最小转弯半径，即当计算出来的圆弧半径小于最小转弯半径时，强制将圆环半径设为最小转弯半径。在道路网络中，通过线数据集只能计算当前点与路段节点的距离，在图5中，若车辆行驶方向为A到B，以传统道路模型算法，则当车辆行驶到O1A时才表示进入路口，在这种情况下相当于将路口滞后了，对于无人地面车辆的交通灯识别、行人避障等会产生很大影响。因此本文提出利用GIS数据库提前存储先验信息，在计算路口距离时考虑斑马线外沿A点到路口节点O1的距离(若左转，则考虑图中A点到路口节点O1的距离)，使得无人地面车辆在行驶到A点时即进入路口模式，此时距离为负，直至行驶到下一个斑马线的外沿时距离值恢复为正，在负距离值期间表示无人地面车辆行驶在路口内。
[0036]本实施方式中对于双线路口模型主要求取关键驶入点和驶出点。以图5为例，假设前一个路口直行通过，当前路口拐弯(以右转为例)。首先读取GIS数据库中B点和C点所在道路的道路宽度，取小者，表示为width，若此时通过路口状态为右转则取width =0.75*width (右转半径小于左转半径);然后由O2点、B点和C点分别确定B点和C点所在道路方向，结合width确定在802连线上的S 坐标和CO 2连线上的S 2点坐标；接着由S i点、&点和其切线方向(即两点各自所在的道路方向)确定圆心O点坐标和半径大小radius ;若无人地面车辆的最小转弯半径小于此时的radius，则结合步长求取S1A到S 2点之间的弧形轨迹路点坐标，反之，则将圆心O点沿着002方向向外顺延，以无人地面车辆的最小转弯半径作为radius确定新的S1点和S2点坐标，进而求取S i点和S 2点间的弧形轨迹路点坐标；最后根据求得的B点和C点的坐标来确定无人地面车辆在路口中的驶入点和驶出点。
[0037]本实施方式中对U-turn路段进行了特殊处理。若在U-turn处的路径生成模式与路口路径的生成模式相同，则相当于在U-turn处将两段圆弧拼接在一起，在拼接处往往会出现“尖角”，这样的“尖角”对于无人地面车辆的运动控制会产生很大影响，也会影响车辆行驶的平滑性，因此本发明中以Hermite插值的方式来处理U-turn路段。利用路口模型找到U-turn的入弯点和出弯点，再结合横向路段的中点，以此三点进行Hermite插值，生成U-turn 轨迹。
[0038]本发明所述的路径规划的实现是采用最经典的Dijikstra算法。首先将本发明所述的空间数据信息的整合和GIS数据库的构建整合成工作空间，本实施方式通过读取保存的工作空间来完成对基础数据的读取。然后读取无人地面车辆任务文件来获取任务点的坐标，并根据任务点的不同属性信息(起点、中间点、终点)将其标注在地图上。
[0039]本实施方式对于路径规划的实现关键之处为路径规划的初始化，首先定义无人地面车辆所需的各项属性变量，根据读取的任务点信息将任务点匹配到距其最近的路段上，判断匹配后的任务点距离其所在路段的起点或终点的远近，选择距离近的端点作为关键点，得到一个以任务点为基础的关键点序列。第二步由得到的关键点序列获取相应路段的SmResistance+SmLength属性值，求得由起点到终点的最短路径，完成初步路径规划。第三步根据本发明所述的道路模型将规划的路径生成以0.4米为间隔的路点，以便向无人地面车辆发送路点数据，此时获得所经路径条数以及整个路径的距离。第四步对生成的路径进行状态赋值，包括速度属性赋值、交通标志属性赋值、车道线数量属性赋值、行驶状态信息和转向及距离信息赋值等。最后完成对整个路径的绘制，以便观察。
[0040]本实施方式对无人地面车辆的在线重新规划设计流程如图8所示。对于无人地面车辆在线重规划的需求情况分为两种:一是无人地面车辆检测到前方有禁行标志，二是前方道路阻断无法通行。对于第一种情况，通过获取禁行路段的ID，修改其相应的阻力值SmResistance来改变路段权重，进而更新数据库，重新规划路径。对于第二种情况，需要先获取当前路段ID，判断所在路段的道路宽度，若符合调转需求，则使无人地面车辆调头，从当前位置重新进行路径规划；若不符合调转需求，则触发倒车模式，沿记录的行驶轨迹倒车行驶至匹配路段ID发生变化的位置，进而修改路段权重，重新规划路径。
[0041]以上结合附图对本发明的【具体实施方式】作了说明，但这些说明不能被理解为限制了本发明的范围，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
【主权项】
1.基于Gis的无人地面车辆自主行驶辅助系统，其特征在于，包括GIS数据库模块、道路模型构建模块和路径规划模块；其中: GIS数据库模块通过整合空间数据信息和构建数据库来完成，所述的空间数据信息的整合即将采集到的空间数据构成不同的数据集，按照数据管理方式逐级分层，并进行整合得到最终所需要的电子地图，是整个系统的数据基础； 道路模型构建模块依据无人地面车辆的运动学特性建立带有路口距离属性的双线路口模型:首先以双线形式为基础构建模型，即道路的正向行驶和逆向行驶以不同的线数据集来构成，对不同的线数据集赋予不同的权重，使得在规划行驶路径的时候不会产生逆向行驶或是在有禁则道路中违规行驶，即模型以城市道路的行车规则为原则进行构建；其次，将直线替换为以预定步长为间隔的很多个路点，在无人地面车辆行驶的过程中，不断给无人地面车辆发送前方路点坐标，指引其前行；最后在模型中添加路口距离属性，在构建的电子地图中，利用路口距离属性来与无人地面车辆进行通信，通知其在到达当前路口的斑马线外沿时表明已经进入路口，直至行驶到下一个斑马线外沿表示驶出本路口，辅助无人地面车辆对路口的精确识别； 路径规划模块给出全局静态路径规划和局部动态路径规划；依据给定任务点的坐标信息，关联所经道路的路口点并进行道路匹配，最终生成途径任务点的最短路径，并对路口点及路段赋上状态信息，完成路径规划的初始化，属于全局静态路径规划；若检测到前方道路有禁行标志或阻塞无法通行，则需要对道路宽度进行判断选择相应的局部动态规划策略，使得无人地面车辆能够继续行驶。
2.如权利要求1所述的基于GIS的无人地面车辆自主行驶辅助系统，其特征在于，所述的GIS数据库模块针对无人地面车辆应用对地理信息系统的数据库进行属性设计，结合无人地面车辆搭载的传感器数据，以更全面的先验信息辅助无人地面车辆的自主行驶。
3.如权利要求2所述的基于GIS的无人地面车辆自主行驶辅助系统，其特征在于，所述的GIS即地理信息系统用于采集、管理、分析和表达地理空间数据，并用于地理环境模型的构建。
4.如权利要求1或2或3所述的基于GIS的无人地面车辆自主行驶辅助系统，其特征在于，其中道路模型构建时考虑无人地面车辆的运动特性，将路口处的直线轨迹以圆弧轨迹来替代，进行圆滑处理，优化无人地面车辆在路口转弯的行驶轨迹。
【专利摘要】本发明提供一种基于GIS的无人地面车辆自主行驶辅助系统，解决了无人地面车辆在未知环境下的自主行驶问题。包括GIS数据库模块、道路模型构建模块和路径规划模块；其中：GIS数据库模块通过整合空间数据信息和构建数据库来完成；道路模型构建模块依据无人地面车辆的运动学特性建立带有路口距离属性的双线路口模型；路径规划模块给出全局静态路径规划和局部动态路径规划；依据给定任务点的坐标信息，关联所经道路的路口点并进行道路匹配，最终生成途径任务点的最短路径，若检测到前方道路有禁行标志或阻塞无法通行，则需要对道路宽度进行判断选择相应的局部动态规划策略，使得无人地面车辆能够继续行驶。
【IPC分类】G01C21-34, G01C21-32
【公开号】CN104819724
【申请号】CN201510093286
【发明人】王美玲, 潘允辉, 杨强荣, 张叶青
【申请人】北京理工大学
【公开日】2015年8月5日
【申请日】2015年3月2日