CN107036619B - High-precision geographic information reconstruction method, device, vehicle decision-making system and server - Google Patents
High-precision geographic information reconstruction method, device, vehicle decision-making system and server Download PDFInfo
- Publication number
- CN107036619B CN107036619B CN201710390962.6A CN201710390962A CN107036619B CN 107036619 B CN107036619 B CN 107036619B CN 201710390962 A CN201710390962 A CN 201710390962A CN 107036619 B CN107036619 B CN 107036619B
- Authority
- CN
- China
- Prior art keywords
- waypoint
- crossing
- attribute
- current
- current waypoint
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags or using precalculated routes
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
Description
技术领域technical field
本发明涉及车辆导航技术领域,尤其涉及高精度地理信息重构方法、装置、车辆决策系统和服务器。The invention relates to the technical field of vehicle navigation, in particular to a high-precision geographic information reconstruction method, device, vehicle decision-making system and server.
背景技术Background technique
随着汽车的数量不断的增多,诸如车辆驾驶安全、交通堵塞、环境污染等社会问题日益突出。由于无人驾驶车辆能够代替普通车辆,减少因人为原因而带来的上述问题,并且可以代替普通车辆完成特殊的行业工作任务,无人驾驶车辆的发展越来越受到人们的关注。With the continuous increase of the number of automobiles, social problems such as vehicle driving safety, traffic congestion, and environmental pollution have become increasingly prominent. Since unmanned vehicles can replace ordinary vehicles, reduce the above-mentioned problems caused by human factors, and can replace ordinary vehicles to complete special industrial tasks, the development of unmanned vehicles has attracted more and more attention.
虽然,自动驾驶汽车可以利用传感器(例如雷达、激光雷达、摄像头等)探测车辆周围情况,但对于整个空间环境的感知能力还是不够。目前,现有的导航地图一般是将车载GPS接收机获得的带有误差的GPS轨迹位置匹配到带有误差的交通矢量地图道路上的相应位置上,导致最终的导航误差在2米左右,其导航精度仍处于道路级。同时,其地图信息还不够丰富,难以达不到最高级别的无人驾驶对地图的要求。Although self-driving cars can use sensors (such as radar, lidar, cameras, etc.) to detect the surrounding conditions of the vehicle, the ability to perceive the entire space environment is still not enough. At present, the existing navigation maps generally match the GPS track position with errors obtained by the vehicle-mounted GPS receiver to the corresponding position on the road with errors in the traffic vector map, resulting in a final navigation error of about 2 meters. Navigation accuracy is still at road level. At the same time, its map information is not rich enough to meet the requirements of the highest level of unmanned driving for maps.
所以,对于最高级别的无人驾驶而言,一张车道级的高精度地图是必不可少的,高精度地图不仅能够提供厘米级的定位坐标,还能准确的描述道路的形状、路点特征以及车辆所在道路的周围环境。而地图产商在制作高精度地图时,一般采用特有的协议(如ADASISv2协议)对地理信息进行封装,封装后的地理信息无法直接提供给车辆的决策系统使用,决策系统需要在接收到这些封装过的高精度地理信息之后,对其进行信息重构才能使用。Therefore, for the highest level of unmanned driving, a lane-level high-precision map is essential. The high-precision map can not only provide centimeter-level positioning coordinates, but also accurately describe the shape of the road and the characteristics of the waypoints. and the surrounding environment of the road on which the vehicle is located. When map manufacturers make high-precision maps, they generally use special protocols (such as the ADASISv2 protocol) to encapsulate geographic information. The encapsulated geographic information cannot be directly provided to the decision-making system of the vehicle. The decision-making system needs to receive these packages. After the high-precision geographic information has been processed, it can only be used after information reconstruction.
因此,如何对高精度地理信息进行重构处理成为本领域技术人员亟需解决的问题。Therefore, how to reconstruct high-precision geographic information has become an urgent problem to be solved by those skilled in the art.
发明内容Contents of the invention
本发明实施例提供了高精度地理信息重构方法、装置、车辆决策系统和服务器,能够重构出车道级的高精度地理信息数据,提供给车辆的决策系统使用,可以满足最高级别的无人驾驶对地图的要求。The embodiment of the present invention provides a high-precision geographic information reconstruction method, device, vehicle decision-making system and server, which can reconstruct high-precision geographic information data at the lane level and provide it to the vehicle decision-making system, which can satisfy the highest level of unmanned Driving on map request.
第一方面,提供了一种高精度地理信息重构方法,包括:In the first aspect, a method for reconstructing high-precision geographic information is provided, including:
接收当前导航任务规划的规划路径的路径数据,所述规划路径由连续的各个路点组成,所述路径数据包括所述规划路径上各个路点的属性参数;receiving path data of a planned path planned by the current navigation task, the planned path is composed of consecutive waypoints, and the path data includes attribute parameters of each waypoint on the planned path;
解析所述路径数据,得到并缓存所述路径数据中所述各个路点的属性参数以及与每个属性参数对应的里程值,所述属性参数包括路口属性参数、车道数目参数、预设附加属性参数和路点的经纬度参数中的至少一个;所述里程值为各个路点距离所述当前导航任务的起点的里程,所述预设附加属性参数包括入路口参数、独立特征参数和出路口参数中的至少一个;Parse the route data, obtain and cache the attribute parameters of each waypoint in the route data and the mileage value corresponding to each attribute parameter, the attribute parameters include intersection attribute parameters, lane number parameters, and preset additional attributes At least one of the parameter and the longitude and latitude parameters of the waypoint; the mileage value is the mileage of each waypoint from the starting point of the current navigation task, and the preset additional attribute parameters include entry parameters, independent feature parameters and exit parameters at least one of;
从所述起点开始依次从缓存中取出一个路点作为当前路点,并将所述当前路点与前一路点进行属性匹配,直至所述缓存中所有路点均完成属性匹配,所述前一路点为前一个取出的路点;Starting from the starting point, a waypoint is successively taken out from the cache as the current waypoint, and attribute matching is performed between the current waypoint and the previous waypoint until all waypoints in the cache complete the attribute matching, and the previous waypoint Point is the waypoint extracted from the previous one;
将所述当前路点与前一路点进行属性匹配具体包括:The attribute matching of the current waypoint and the previous waypoint specifically includes:
根据所述各个路点的属性参数中里程值与所述当前路点的里程值相等的所述预设附加属性参数和/或所述路口属性参数,以及所述前一路点的路口匹配状态确定所述当前路点的路点属性,所述路点属性包括终点、入路口、特殊路口、路上点、出路口、路口内点、配对出路口或出路口候补点中的一个,所述路口匹配状态包括处于路口外、已匹配入路口、已匹配特殊停止路口和已匹配出路口中的一个;Determine according to the preset additional attribute parameter and/or the intersection attribute parameter in which the mileage value of the attribute parameters of each waypoint is equal to the mileage value of the current waypoint, and the intersection matching state of the previous waypoint The waypoint attribute of the current waypoint, the waypoint attribute includes an end point, an entry point, a special intersection, an on-way point, an exit point, an intersection interior point, a paired exit point, or an exit point candidate, and the intersection matches The state includes one of being outside an intersection, matching an intersection, matching a special stop intersection, and matching an exit;
根据所述当前路点的路点属性设置所述当前路点的属性参数和路口匹配状态;Setting attribute parameters and intersection matching status of the current waypoint according to the waypoint attribute of the current waypoint;
根据所述当前路点的车道数目参数设置所述当前路点的车道数目的值。The value of the number of lanes at the current waypoint is set according to the parameter of the number of lanes at the current waypoint.
第二方面,提供了一种高精度地理信息重构装置,包括:In the second aspect, a device for reconstructing high-precision geographic information is provided, including:
路径数据接收模块,用于接收当前导航任务规划的规划路径的路径数据,所述规划路径由连续的各个路点组成,所述路径数据包括所述规划路径上各个路点的属性参数;The route data receiving module is used to receive the route data of the planned route planned by the current navigation task, the planned route is composed of continuous way points, and the route data includes attribute parameters of each way point on the planned route;
解析缓存模块,用于解析所述路径数据,得到并缓存所述路径数据中所述各个路点的属性参数以及与每个属性参数对应的里程值,所述属性参数包括路口属性参数、车道数目参数、预设附加属性参数和路点的经纬度参数中的至少一个;所述里程值为各个路点距离所述当前导航任务的起点的里程,所述预设附加属性参数包括入路口参数、独立特征参数和出路口参数中的至少一个;The parsing cache module is used to parse the path data, obtain and cache the attribute parameters of each waypoint in the path data and the mileage value corresponding to each attribute parameter, and the attribute parameters include intersection attribute parameters and the number of lanes Parameters, preset additional attribute parameters and at least one of the longitude and latitude parameters of the waypoints; the mileage value is the mileage of each waypoint from the starting point of the current navigation task, and the preset additional attribute parameters include entry parameters, independent At least one of characteristic parameters and exit parameters;
属性匹配模块,用于从所述起点开始依次从缓存中取出一个路点作为当前路点,并将所述当前路点与前一路点进行属性匹配,直至所述缓存中所有路点均完成属性匹配,所述前一路点为前一个取出的路点;The attribute matching module is used to sequentially take out a waypoint from the cache as the current waypoint starting from the starting point, and perform attribute matching on the current waypoint and the previous waypoint until all the waypoints in the cache have completed the attributes Matching, the previous waypoint is the previous taken out waypoint;
所述属性匹配模块包括:The attribute matching module includes:
路点属性确定单元,用于根据所述各个路点的属性参数中里程值与所述当前路点的里程值相等的所述预设附加属性参数和/或所述路口属性参数,以及所述前一路点的路口匹配状态确定所述当前路点的路点属性,所述路点属性包括终点、入路口、特殊路口、路上点、出路口、路口内点、配对出路口或出路口候补点中的一个,所述路口匹配状态包括处于路口外、已匹配入路口、已匹配特殊停止路口和已匹配出路口中的一个;The waypoint attribute determination unit is configured to use the preset additional attribute parameter and/or the intersection attribute parameter whose mileage value is equal to the mileage value of the current waypoint among the attribute parameters of each waypoint, and the The intersection matching state of the previous waypoint determines the waypoint attributes of the current waypoint, and the waypoint attributes include end point, entrance, special intersection, waypoint, exit, interior point, paired exit or exit candidate One of the intersection matching status includes one of being outside the intersection, matching the intersection, matching the special stop intersection and matching the exit intersection;
属性参数设置单元,用于根据所述当前路点的路点属性设置所述当前路点的属性参数和路口匹配状态;An attribute parameter setting unit, configured to set the attribute parameter of the current waypoint and the intersection matching state according to the waypoint attribute of the current waypoint;
车道数目设置单元,用于根据所述当前路点的车道数目参数设置所述当前路点的车道数目的值。The number of lanes setting unit is configured to set the value of the number of lanes at the current waypoint according to the number of lanes at the current waypoint.
第三方面,提供了一种车辆决策系统,包括上述的高精度地理信息重构装置。In a third aspect, a vehicle decision-making system is provided, including the above-mentioned device for reconstructing high-precision geographic information.
第四方面,提供了一种服务器,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述的高精度地理信息重构方法的步骤。In a fourth aspect, a server is provided, including a memory, a processor, and a computer program stored in the memory and operable on the processor, and the above-mentioned high precision is achieved when the processor executes the computer program Steps of the geographic information reconstruction method.
第五方面,提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述的高精度地理信息重构方法的步骤。In a fifth aspect, a computer-readable storage medium is provided, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the above-mentioned method for reconstructing high-precision geographic information are realized.
从以上技术方案可以看出,本发明实施例具有以下优点:It can be seen from the above technical solutions that the embodiments of the present invention have the following advantages:
本发明实施例中,在接收当前导航任务规划的规划路径的路径数据之后,对路径数据进行解析,并从解析出的数据中提取所需信息,包括路口属性参数、车道数目参数、预设附加属性参数、路点的经纬度参数以及各个参数对应的里程值,所述预设附加属性参数包括入路口参数、独立特征参数和出路口参数中的至少一个,根据这些提取到的信息将当前路点与前一路点进行属性匹配,确定当前路点的路点属性和路口匹配状态,并设置当前路点的车道数属性,从而完成当前路点的属性匹配。当从当前导航任务的规划路径的起点开始依次完成所有路点的属性匹配之后,完成本次地理信息重构。可见,即便高精度地图产商采用特有的协议对地理信息进行封装,本发明中的高精度地理信息重构方法也能够对当前导航任务提供的路径数据进行解封,再从解封后的路径数据中提取所需的地理信息并重构出车道级的高精度地理信息数据,提供给车辆的决策系统使用,可以满足最高级别的无人驾驶对地图的要求。In the embodiment of the present invention, after receiving the path data of the planned path planned by the current navigation task, the path data is analyzed, and the required information is extracted from the parsed data, including intersection attribute parameters, lane number parameters, preset additional Attribute parameters, latitude and longitude parameters of waypoints, and mileage values corresponding to each parameter, the preset additional attribute parameters include at least one of entry parameters, independent feature parameters, and exit parameters, and the current waypoint Perform attribute matching with the previous waypoint, determine the waypoint attribute and intersection matching status of the current waypoint, and set the lane number attribute of the current waypoint, so as to complete the attribute matching of the current waypoint. After the attribute matching of all waypoints is completed sequentially from the starting point of the planned path of the current navigation task, this geographical information reconstruction is completed. It can be seen that even if the high-precision map manufacturer adopts a unique protocol to encapsulate geographic information, the high-precision geographic information reconstruction method in the present invention can also unpack the path data provided by the current navigation task, and then use the unpacked path data The required geographic information is extracted from the data and reconstructed into lane-level high-precision geographic information data, which is provided to the vehicle's decision-making system to meet the requirements of the highest level of unmanned driving for maps.
附图说明Description of drawings
图1为高精度地图导航仪、高精度定位装置与车辆决策系统的连接示意图;Figure 1 is a schematic diagram of the connection between a high-precision map navigator, a high-precision positioning device and a vehicle decision-making system;
图2为高精度地图导航仪与车辆决策系统的握手流程示意图;Figure 2 is a schematic diagram of the handshake process between the high-precision map navigator and the vehicle decision-making system;
图3为本发明实施例中一种高精度地理信息重构方法一个实施例的流程示意图;FIG. 3 is a schematic flow diagram of an embodiment of a method for reconstructing high-precision geographic information in an embodiment of the present invention;
图4为本发明实施例中一种高精度地理信息重构方法步骤303中将所述当前路点与前一路点进行属性匹配的流程示意图;FIG. 4 is a schematic flowchart of attribute matching between the current waypoint and the previous waypoint in step 303 of a method for reconstructing high-precision geographic information in an embodiment of the present invention;
图5为一个应用场景中的复杂交叉路口示意图;Fig. 5 is a schematic diagram of a complex intersection in an application scenario;
图6为一个应用场景中的U-Turn路口示意图;Figure 6 is a schematic diagram of a U-Turn intersection in an application scenario;
图7为一个应用场景中的普通交叉路口示意图;FIG. 7 is a schematic diagram of a common intersection in an application scenario;
图8为本发明实施例中一种高精度地理信息重构方法在一个应用场景下车辆决策系统接收高精度导航仪的路径数据的流程示意图;FIG. 8 is a schematic flow diagram of a high-precision geographic information reconstruction method in an application scenario in which the vehicle decision-making system receives path data from a high-precision navigator in an embodiment of the present invention;
图9为本发明实施例中一种高精度地理信息重构方法检测自定义属性参数并进行属性设置的流程示意图;FIG. 9 is a schematic flow diagram of detecting custom attribute parameters and setting attributes by a high-precision geographic information reconstruction method in an embodiment of the present invention;
图10为本发明实施例中一种高精度地理信息重构装置一个实施例结构图;FIG. 10 is a structural diagram of an embodiment of a high-precision geographic information reconstruction device in an embodiment of the present invention;
图11为本发明一实施例提供的服务器的示意图。Fig. 11 is a schematic diagram of a server provided by an embodiment of the present invention.
具体实施方式Detailed ways
本发明实施例提供了高精度地理信息重构方法、装置、车辆决策系统和服务器,用于解决如何对高精度地理信息进行重构处理的问题。Embodiments of the present invention provide a method and device for reconstructing high-precision geographic information, a vehicle decision-making system, and a server for solving the problem of how to reconstruct high-precision geographic information.
为使得本发明的发明目的、特征、优点能够更加的明显和易懂,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,下面所描述的实施例仅仅是本发明一部分实施例,而非全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。In order to make the purpose, features and advantages of the present invention more obvious and understandable, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the following The described embodiments are only some, not all, embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the protection scope of the present invention.
如图1所示,无人驾驶的车辆上需要安装高精度地图导航仪和高精度定位装置,高精度地图导航仪与车辆决策系统通过CAN总线连接,而高精度定位装置与车辆决策系统通过UART连接。As shown in Figure 1, a high-precision map navigator and a high-precision positioning device need to be installed on an unmanned vehicle. The high-precision map navigator and the vehicle decision-making system are connected through the CAN bus, and the high-precision positioning device and the vehicle decision-making system are connected through the UART connect.
在一种应用场景中,在导航仪给决策系统发送导航的路径数据之前,导航仪与车辆决策系统之间还需要一个握手过程。如图2所示,启动无人驾驶车辆,高精度地图导航仪、高精度定位装置上电初始化完成,启动决策系统程序,在导航仪上规划一条可行的路径(导航仪采用ADASIS v2协议对路径规划的结果进行封装),接着导航仪与无人驾驶汽车的决策系统经握手确认后,导航仪向无人驾驶汽车决策系统发送用ADASIS V2协议封装的路径数据,其中,导航仪每隔多远距离发送一次ADAS Horizon数据是可根据需求配置的。于此同时,决策系统会定时将高精度定位信息发送给导航仪,该信息可以作为车道级的地图显示,当车辆往前行驶一段距离后,当决策系统已经接收但还没有途经的ADAS Horizon数据不足2千米时,导航仪会补充发送采用ADASIS V2协议封装的后续路径数据,直至车辆行驶至当前导航任务的终点。每当接收到高精度导航仪发来的路径数据,车辆决策系统就会采用本发明提供的高精度地理信息重构方法重构出规定格式的高精度的地理信息。In one application scenario, before the navigator sends navigation route data to the decision-making system, a handshake process is required between the navigator and the vehicle decision-making system. As shown in Figure 2, the unmanned vehicle is started, the high-precision map navigator and the high-precision positioning device are powered on and initialized, the decision-making system program is started, and a feasible path is planned on the navigator (the navigator adopts the ADASIS v2 protocol to determine the route) The results of the planning are encapsulated), and then the navigator and the decision-making system of the unmanned vehicle are confirmed by handshake, and the navigator sends the path data encapsulated with the ADASIS V2 protocol to the decision-making system of the unmanned vehicle. The distance to send ADAS Horizon data once can be configured according to requirements. At the same time, the decision-making system will regularly send high-precision positioning information to the navigator. This information can be displayed as a lane-level map. When the vehicle drives forward for a certain distance, when the decision-making system has received but has not yet passed ADAS Horizon data When the distance is less than 2 kilometers, the navigator will send additional follow-up path data encapsulated in the ADASIS V2 protocol until the vehicle reaches the end of the current navigation task. Whenever the route data sent by the high-precision navigator is received, the vehicle decision-making system will use the high-precision geographic information reconstruction method provided by the present invention to reconstruct high-precision geographic information in a specified format.
如下表一示出了本发明实施例中的一种重构后的地理信息格式。Table 1 below shows a format of the reconstructed geographical information in the embodiment of the present invention.
表一Table I
如表一所示,序号1、2分别表示两个重构后的地理信息。每个地理信息均包括经度、纬度、高度、属性1~9等属性参数。其中,属性1表征路点的路点属性,属性2表征路点的路口点属性,属性3表征路点的车道数目,属性4~9为自定义属性,其具体表征的属性可以根据需要自行定义。As shown in Table 1, serial numbers 1 and 2 represent two reconstructed geographical information respectively. Each piece of geographic information includes attribute parameters such as longitude, latitude, height, and attributes 1-9. Among them, attribute 1 represents the waypoint attribute of the waypoint, attribute 2 represents the intersection point attribute of the waypoint, attribute 3 represents the number of lanes of the waypoint, attributes 4 to 9 are self-defined attributes, and the specific attributes can be defined according to the needs .
请参阅图3,本发明实施例中一种高精度地理信息重构方法包括:Referring to Fig. 3, a method for reconstructing high-precision geographic information in an embodiment of the present invention includes:
301、接收当前导航任务规划的规划路径的路径数据,所述规划路径由连续的各个路点组成,所述路径数据包括所述规划路径上各个路点的属性参数;301. Receive path data of a planned path planned by the current navigation task, where the planned path is composed of consecutive waypoints, and the path data includes attribute parameters of each waypoint on the planned path;
302、解析所述路径数据,得到并缓存所述路径数据中所述各个路点的属性参数以及与每个属性参数对应的里程值,所述属性参数包括路口属性参数、车道数目参数、预设附加属性参数和路点的经纬度参数中的至少一个;所述里程值为各个路点距离所述当前导航任务的起点的里程,所述预设附加属性参数包括入路口参数、独立特征参数和出路口参数中的至少一个;302. Analyze the route data, obtain and cache the attribute parameters of each waypoint in the route data and the mileage value corresponding to each attribute parameter, the attribute parameters include intersection attribute parameters, lane number parameters, preset At least one of the additional attribute parameters and the longitude and latitude parameters of the waypoints; the mileage value is the mileage of each waypoint from the starting point of the current navigation task, and the preset additional attribute parameters include entry parameters, independent feature parameters and exit parameters. at least one of the intersection parameters;
303、从所述起点开始依次从缓存中取出一个路点作为当前路点,并将所述当前路点与前一路点进行属性匹配,直至所述缓存中所有路点均完成属性匹配,所述前一路点为前一个取出的路点。303. Starting from the starting point, one waypoint is sequentially taken out from the cache as the current waypoint, and attribute matching is performed on the current waypoint and the previous waypoint until all the waypoints in the cache complete attribute matching, the The previous waypoint is the waypoint taken out before.
对于步骤301,在高精度导航仪为当前导航任务规划好路径之后,其可以将路径数据发送至车辆决策系统,车辆决策系统接收这些路径数据。For step 301, after the high-precision navigator has planned the route for the current navigation task, it can send the route data to the vehicle decision-making system, and the vehicle decision-making system receives the route data.
对于步骤302,由于高精度导航仪一般采用特有协议封装这些路径数据,使得这些路径数据无法被车辆决策系统直接使用,因此车辆决策系统在接收到这些路径数据之后,首先可以解析这些路径数据,得到相关的参数,并放入缓存区中。For step 302, since high-precision navigators generally use a unique protocol to encapsulate these route data, these route data cannot be directly used by the vehicle decision-making system. Therefore, after the vehicle decision-making system receives these route data, it can first analyze these route data and obtain Related parameters, and put into the cache.
在本实施例中,里程值是路径数据中每个参数均附带的值,其用于表征各个参数处于路径上的位置距离起点的里程。因此,可以理解的是,对于同一条规划路径(即导航路线),当两个参数的里程值一样时,说明这两个参数所处的位置距离规划路径的起点的里程长度是一样的,因此可以确定这两个参数在该规划路径上处于同一个位置上。In this embodiment, the mileage value is a value attached to each parameter in the route data, which is used to represent the mileage of each parameter on the route from the starting point. Therefore, it can be understood that, for the same planned route (i.e., navigation route), when the mileage values of the two parameters are the same, it means that the mileage lengths between the positions of the two parameters and the starting point of the planned route are the same, so It can be determined that these two parameters are at the same position on the planned path.
上述的预设附加属性参数除了可以包括入路口参数、独立特征参数和出路口参数中的一个、两个或多个之外,还可以包括出路口候补点、独立斑马线、是否变道后起点、是否变道前终点、当前车道编号、当前车道允许变道属性、车道宽度,等等。其中,该独立特征参数可以包括非路口红绿灯和/或独立停止线。The above-mentioned preset additional attribute parameters may include one, two or more of the entry parameters, independent feature parameters and exit parameters, as well as exit candidate points, independent zebra crossings, starting point after lane change, Whether to end before changing lanes, the number of the current lane, the attribute of the current lane to allow lane change, the width of the lane, etc. Wherein, the independent characteristic parameters may include non-intersection traffic lights and/or independent stop lines.
对于步骤302,在一个应用场景下,如图8所示,在高精度导航仪与车辆决策系统握手成功后,高精度导航仪采用ADASIS v2协议来封装路径数据,则车辆决策系统通过接受CAN总线报文得到ADAS Horizon数据,这些ADAS Horizon数据可以分为STUB消息、SEGMENT消息PROFILE SHORT消息和PROFILE LONG消息发送给车辆决策系统。车辆决策系统接收该STUB消息,解析出其offset属性(相当于里程值,下同)和路口属性参数,并放入缓存区;接收SEGMENT消息,解析出其offset属性和车道数目参数,并放入缓存区;接收PROFILE SHORT消息,解析出其offset属性以及各种预设附加属性参数,并放入缓存区;接收PROFILE LONG消息,解析出路点的经纬度参数以及其offset属性,并放入缓存区。在接收到这些消息后,即对这些消息进行地理信息重构,直到到达导航任务的终点。For step 302, in an application scenario, as shown in Figure 8, after the high-precision navigator successfully shakes hands with the vehicle decision-making system, the high-precision navigator uses the ADASIS v2 protocol to encapsulate the path data, and the vehicle decision-making system accepts the CAN bus The message obtains ADAS Horizon data, which can be divided into STUB messages, SEGMENT messages, PROFILE SHORT messages and PROFILE LONG messages, which are sent to the vehicle decision-making system. The vehicle decision-making system receives the STUB message, parses out its offset attribute (equivalent to the mileage value, the same below) and intersection attribute parameters, and puts them into the buffer area; receives the SEGMENT message, parses out its offset attribute and lane number parameters, and puts them in Buffer area; receive PROFILE SHORT message, analyze its offset attribute and various preset additional attribute parameters, and put it into the buffer area; receive PROFILE LONG message, parse the longitude and latitude parameters of the waypoint and its offset attribute, and put it into the buffer area. After receiving these messages, the geographical information of these messages is reconstructed until the end of the navigation task is reached.
需要说明的是,导航仪发送的ADASIS数据中设有丢帧检测参数cycn,该cycn均按0、1、2、3循环计数,因此,接收端(即车辆决策系统)可依据此机制判断是否出现数据丢帧。当无人驾驶汽车的决策系统检测到接收的ADASIS有数据丢帧情况,决策系统抛弃已接收的数据,并向导航仪发送重发请求,导航仪才重新发送已发送过的ADASIS数据(包括STUB、SEGMENT、PROFILE SHORT以及PROFILE LONG数据)。It should be noted that the frame loss detection parameter cycn is set in the ADASIS data sent by the navigator, and the cycn is counted in cycles of 0, 1, 2, and 3. Therefore, the receiving end (that is, the vehicle decision-making system) can judge whether to Data frame loss occurs. When the decision-making system of the driverless car detects that the received ADASIS data frame is lost, the decision-making system discards the received data and sends a resend request to the navigator, and the navigator resends the sent ADASIS data (including STUB , SEGMENT, PROFILE SHORT, and PROFILE LONG data).
对于步骤303,所述前一路点是指相对当前路点而言前一个取出的路点。在本实施例中,地理信息的重构是通过对当前导航任务规划的规划路径上各个路点依次进行属性匹配完成的,并且在属性匹配时,当前路点需要对比和参考前一路点所处的状态。可以理解的是,对于路径数据中的第一个路点,一般来说是起点,其属性匹配可以采用默认的方式设置完成。For step 303, the previous waypoint refers to the previously retrieved waypoint relative to the current waypoint. In this embodiment, the reconstruction of geographic information is accomplished by sequentially performing attribute matching on each waypoint on the planned route of the current navigation task plan, and when matching attributes, the current waypoint needs to be compared and referred to where the previous waypoint is located. status. It can be understood that, for the first waypoint in the route data, generally speaking, it is the starting point, and its attribute matching can be set in a default manner.
在步骤303中,如图4所示,将所述当前路点与前一路点进行属性匹配具体可以包括:In step 303, as shown in FIG. 4 , performing attribute matching on the current waypoint and the previous waypoint may specifically include:
401、根据所述各个路点的属性参数中里程值与所述当前路点的里程值相等的所述预设附加属性参数和/或所述路口属性参数,以及所述前一路点的路口匹配状态确定所述当前路点的路点属性,所述路点属性包括终点、入路口、特殊路口、路上点、出路口、路口内点、配对出路口或出路口候补点中的一个,所述路口匹配状态包括处于路口外、已匹配入路口、已匹配特殊停止路口和已匹配出路口中的一个;401. According to the preset additional attribute parameters and/or the intersection attribute parameters in which the mileage value of the attribute parameters of each waypoint is equal to the mileage value of the current waypoint, and the intersection matching of the previous waypoint The state determines the waypoint attribute of the current waypoint, and the waypoint attribute includes one of an end point, an entry point, a special intersection, a point on the way, an exit point, an interior point of an intersection, a paired exit point, or a candidate point for an exit point. The intersection matching status includes one of being outside the intersection, matching the intersection, matching the special stop intersection and matching the exit intersection;
402、根据所述当前路点的路点属性设置所述当前路点的属性参数和路口匹配状态;402. Set attribute parameters and intersection matching status of the current waypoint according to the waypoint attributes of the current waypoint;
403、根据所述当前路点的车道数目参数设置所述当前路点的车道数目的值。403. Set the value of the number of lanes at the current waypoint according to the parameter of the number of lanes at the current waypoint.
对于上述步骤401~403,首先需要说明的是,在高精度导航仪的导航规划中,“路口”的状态对于车辆的行驶具有重要的参考价值和意义。这里说的路口并非日常生活中所指的马路路口,而是指车辆在车道上行驶的过程中遇到的需要进行回应、处理的路段。如图5、图6和图7所示,图5示出了一种复杂交叉路口,图5中带有箭头的线段为车辆行驶的方向和车道,当车辆途经该路口时,需要从路口入口点进入路口,然后从路口出口点离开该路口。图6示出了一种U-Turn路口,也即常说的“调头”路口,当车辆途经该U-Turn路口时,也是从路口入口点进入路口,然后从路口出口点离开该路口。图7示出了一种普通交叉路口,也即常说的三叉路口,当车辆途经该普通交叉路口时,也是从路口入口点进入路口,然后从路口出口点离开该路口。可见,本实施例中对于路口的定义,当车辆经过一个路口时,均是从路口入口点进入路口,然后从路口出口点离开该路口。因此,在导航的过程中,判断车辆当前处于路口的何种状态下对于车辆的导航非常重要。本实施例采用路口匹配状态来表征车辆当前处于路口的何种状态,该路口匹配状态包括处于路口外、已匹配入路口、已匹配特殊停止路口或已匹配出路口。其中,已匹配特殊停止路口是指已匹配非路口红绿灯或独立停止线。For the above steps 401-403, it should first be explained that in the navigation planning of the high-precision navigator, the state of the "intersection" has important reference value and significance for the driving of the vehicle. The intersection mentioned here is not the road intersection referred to in daily life, but refers to the road section that needs to be responded and processed when the vehicle is driving on the lane. As shown in Figure 5, Figure 6 and Figure 7, Figure 5 shows a complex intersection, the line segment with the arrow in Figure 5 is the direction and lane of the vehicle, when the vehicle passes the intersection, it needs to enter the intersection Enter the intersection at the point and leave the intersection at the exit point of the intersection. Figure 6 shows a U-Turn intersection, also known as a "turn around" intersection, when a vehicle passes through the U-Turn intersection, it also enters the intersection from the intersection entry point, and then leaves the intersection from the intersection exit point. Fig. 7 shows a common intersection, also known as a three-fork intersection, when a vehicle passes through the common intersection, it also enters the intersection from the intersection entry point, and then leaves the intersection from the intersection exit point. It can be seen that for the definition of intersection in this embodiment, when a vehicle passes through an intersection, it enters the intersection from the intersection entry point, and then leaves the intersection from the intersection exit point. Therefore, in the process of navigation, it is very important for the navigation of the vehicle to determine what state the vehicle is currently at at the intersection. In this embodiment, the intersection matching state is used to represent the state of the intersection that the vehicle is currently in. The intersection matching state includes being outside the intersection, matching the intersection, matching the special stop intersection, or matching the exit intersection. Among them, the matched special stop intersection refers to the matched non-intersection traffic lights or independent stop lines.
本实施例中,进一步地,上述步骤401具体可以包括如下步骤A~E:In this embodiment, further, the above step 401 may specifically include the following steps A-E:
A、当前一路点的路口匹配状态为处于路口外时:若所述当前路点的里程值满足预设里程条件,则确定所述当前路点为终点;若存在对应里程值与所述当前路点的里程值相等的入路口参数,且在所述里程值相等的入路口参数的预设里程偏移范围内查找到路口属性参数,则确定所述当前路点为入路口;若存在对应里程值与所述当前路点的里程值相等的独立特征参数,则确定所述当前路点为特殊路口;反之,则确定所述当前路点为路上点;A. When the intersection matching state of the current road point is outside the intersection: if the mileage value of the current road point satisfies the preset mileage condition, then determine that the current road point is the end point; if there is a corresponding mileage value and the current road point If the mileage value of the point is equal to the entry parameter, and the intersection attribute parameter is found within the preset mileage offset range of the entry parameter with the same mileage value, then it is determined that the current waypoint is an entry; if there is a corresponding mileage If the value is equal to the independent characteristic parameter of the mileage value of the current waypoint, then it is determined that the current waypoint is a special intersection; otherwise, it is determined that the current waypoint is a waypoint;
B、当前一路点的路口匹配状态为已匹配入路口时:若所述当前路点的里程值满足预设里程条件,则确定所述当前路点为终点;若存在对应里程值与所述当前路点的里程值相等的出路口参数,则确定所述当前路点为出路口;反之,则确定所述当前路点为路口内点;B. When the intersection matching state of the current road point is the matched intersection: if the mileage value of the current way point satisfies the preset mileage condition, it is determined that the current way point is the end point; if there is a corresponding mileage value and the current If the mileage value of the waypoint is equal to the exit parameter, then it is determined that the current waypoint is an exit; otherwise, it is determined that the current waypoint is an intersection interior point;
C、当前一路点的路口匹配状态为已匹配特殊停止路口时:若所述当前路点的里程值满足预设里程条件,则确定所述当前路点为终点;若存在对应里程值与所述当前路点的里程值相等的入路口参数,则确定所述当前路点为路口内点;若存在对应里程值与所述当前路点的里程值相等的出路口参数,则确定所述当前路点为出路口;反之,则确定所述当前路点为配对出路口;C. When the intersection matching state of the current road point is matched with a special stop intersection: if the mileage value of the current way point satisfies the preset mileage condition, it is determined that the current way point is the end point; if there is a corresponding mileage value and the If there is an intersection parameter whose mileage value is equal to the current waypoint, then determine that the current waypoint is an intersection interior point; if there is an intersection parameter whose corresponding mileage value is equal to the mileage value of the current waypoint, then determine the point is an exit; otherwise, it is determined that the current waypoint is a paired exit;
D、当前一路点的路口匹配状态为已匹配出路口时:若所述当前路点的里程值与前一路点的里程值相等,则确定所述当前路点为出路口候补点;若所述当前路点的里程值与前一路点的里程值不相等,则跳转至所述当前一路点的路口匹配状态为处于路口外时的步骤。D. When the intersection matching state of the current road point is the matched exit: if the mileage value of the current way point is equal to the mileage value of the previous road point, then determine that the current way point is an exit candidate point; if the If the mileage value of the current waypoint is not equal to the mileage value of the previous waypoint, jump to the step when the intersection matching state of the current waypoint is outside the intersection.
需要说明的是,在上述步骤A~C中,上述的“反之”一词表示的是:在该步骤中,当步骤内前述所有条件均不满足时,则执行“反之”一词后的步骤。具体说明为,比如上述步骤A,执行步骤A的前提条件为“前一路点的路口匹配状态为处于路口外”,只有当满足这个前提条件时,才能执行该步骤A。假设已满足“前一路点的路口匹配状态为处于路口外”这个条件(下述简称条件A1),在执行步骤A时,先判断是否满足条件A1,若满足,则确定所述当前路点为终点,此时,步骤A执行完毕;只有当不满足条件A1时,再判断是否满足“存在对应里程值与所述当前路点的里程值相等的入路口参数,且在所述里程值相等的入路口参数的预设里程偏移范围内查找到路口属性参数”这个条件(下述简称条件A2),如果满足,则确定所述当前路点为入路口,同样的,由于已确定当前路点的路点属性,那么步骤A执行完毕;同理,只有当既不满足条件A1也不满足条件A2时,再判断是否满足“存在对应里程值与所述当前路点的里程值相等的独立特征参数”这个条件(下述简称条件A3),如果满足,则确定所述当前路点为特殊路口,步骤A执行完毕。如果上述的条件A1、条件A2和条件A3均不满足,这时则认为满足步骤A中的“反之”的条件,也即在均不满足条件A1、条件A2和条件A3的情况下,确定所述当前路点为路上点。同理可知,对于上述步骤B、C和D中的条件判断和路点属性的确定均与上述步骤A的表述类似,在步骤B和步骤C中,“反之”一词的适用情况和满足条件与步骤A类似,此处不再赘述。It should be noted that, in the above steps A~C, the above-mentioned word "conversely" means: in this step, when all the aforementioned conditions in the step are not satisfied, the steps after the word "conversely" are executed . Specifically, for example, in the above step A, the precondition for executing step A is "the intersection matching state of the previous road point is outside the intersection", and only when this precondition is met, step A can be executed. Assuming that the condition (hereinafter referred to as condition A1) of "the intersection matching state of the previous road point is outside the intersection" has been met, when step A is executed, it is first judged whether the condition A1 is satisfied, if satisfied, then it is determined that the current waypoint is End point, at this point, step A is executed; only when condition A1 is not satisfied, then judge whether to meet "there is an entry parameter whose corresponding mileage value is equal to the mileage value of the current waypoint, and at the point where the mileage value is equal Find the condition "crossing attribute parameter" (hereinafter referred to as condition A2) within the preset mileage offset range of the entrance parameter, if satisfied, then determine that the current waypoint is the entrance. Similarly, because the current waypoint has been determined waypoint attribute, then step A is completed; similarly, only when neither condition A1 nor condition A2 is satisfied, then it is judged whether it is satisfied that "there is an independent feature whose corresponding mileage value is equal to the mileage value of the current waypoint parameter" (hereinafter referred to as condition A3), if it is satisfied, then it is determined that the current waypoint is a special intersection, and step A is executed. If above-mentioned condition A1, condition A2 and condition A3 all do not meet, at this moment then think to meet the condition of " opposite " in the step A, namely under the situation that all do not satisfy condition A1, condition A2 and condition A3, determine all Describe the current waypoint as the waypoint. In the same way, it can be seen that the conditional judgment and the determination of the waypoint attributes in the above steps B, C and D are similar to the expression of the above step A. In the steps B and C, the applicability and satisfaction of the word "conversely" It is similar to step A and will not be repeated here.
其中,对于上述的步骤A~D中,所说的“预设里程条件”可以根据导航仪发送过来里程值的具体情况进行设定。比如,在采用ADASIS v2协议的导航仪,其发送过来的路径数据中的非终点的里程值一般设置在[0,8190]的范围内,若接收到该导航仪中某个路点的里程值大于这个范围,比如里程值等于8191,则可以认为该路点的里程值满足预设的里程条件,则确定为该路点为终点。对于上述里程条件的预先设定,本实施例中对此不做限定。Wherein, for the above steps A-D, the "preset mileage condition" can be set according to the specific situation of the mileage value sent by the navigator. For example, in a navigator using the ADASIS v2 protocol, the non-destination mileage value in the route data sent by it is generally set within the range of [0,8190]. If the mileage value of a certain waypoint in the navigator is received If it is greater than this range, for example, if the mileage value is equal to 8191, then it can be considered that the mileage value of the waypoint satisfies the preset mileage condition, and the waypoint is determined as the end point. There is no limitation to the preset mileage condition in this embodiment.
对于步骤402,本实施例中,进一步地,上述步骤401具体可以包括如下步骤(1)~(8):For step 402, in this embodiment, further, the above step 401 may specifically include the following steps (1)-(8):
(1)若所述当前路点为终点,则将所述当前路点的路点属性设为终点,路口点属性设为无属性,路口匹配状态设为处于路口外;(1) If the current waypoint is the end point, the waypoint attribute of the current waypoint is set as the end point, the intersection point attribute is set as no attribute, and the intersection matching state is set as being outside the intersection;
(2)若所述当前路点为入路口,则将所述当前路点的路点属性设为入路口,路口点属性设为查找到的所述路口属性参数的路口属性,路口匹配状态设为已匹配入路口;(2) If the current waypoint is an intersection, then the waypoint attribute of the current waypoint is set as an intersection, the intersection point attribute is set as the intersection attribute of the intersection attribute parameter found, and the intersection matching state is set is the matched entry point;
(3)若所述当前路点为特殊路口,则将所述当前路点的路点属性设为入路口,路口点属性设为路口直行,路口匹配状态设为已匹配特殊停止路口;(3) If the current waypoint is a special intersection, then the waypoint attribute of the current waypoint is set as an intersection, the attribute of the intersection point is set as a straight line at the intersection, and the matching state of the intersection is set as a matched special stop intersection;
(4)若所述当前路点为路上点,则将所述当前路点的路点属性设为路上点,路口点属性设为无属性,路口匹配状态设为处于路口外;(4) If the current waypoint is a waypoint, then the waypoint attribute of the current waypoint is set as a waypoint, the intersection point attribute is set as no attribute, and the intersection matching state is set as being outside the intersection;
(5)若所述当前路点为出路口,则将所述当前路点的路点属性设为出路口,路口点属性设为无属性,路口匹配状态设为已匹配出路口;(5) If the current waypoint is an exit, then the waypoint attribute of the current waypoint is set as an exit, the intersection point attribute is set as no attribute, and the matching state of the intersection is set as a matched exit;
(6)若所述当前路点为路口内点,则将所述当前路点的路点属性设为路口内点,路口点属性设为无属性,路口匹配状态设为已匹配入路口;(6) If the current waypoint is an intersection interior point, then the roadpoint attribute of the current waypoint is set as an intersection interior point, the intersection point attribute is set as no attribute, and the intersection matching state is set as a matched entrance;
(7)若所述当前路点为配对出路口,则将所述当前路点的路点属性设为出路口,路口点属性设为无属性,路口匹配状态设为已匹配出路口;(7) If the current waypoint is a matching exit, then the waypoint attribute of the current waypoint is set as an exit, the intersection point attribute is set as no attribute, and the matching state of the intersection is set as a matched exit;
(8)若所述当前路点为出路口候补点,则将所述当前路点的经纬度参数存入至前一个出路口的候补点经纬度数组,且所述前一个出路口的候补点点数加1;判断所述前一个出路口的候补点点数是否大于或等于所述前一个出路口的车道数减1,若是,则将所述当前路点的路口匹配状态设为处于路口外,若否,则将所述当前路点的路口匹配状态设为已匹配出路口。(8) If the current waypoint is a candidate exit point, store the latitude and longitude parameters of the current waypoint into the latitude and longitude array of candidate points of the previous exit, and add the points of the candidate points of the previous exit to 1; determine whether the number of candidate points at the previous exit is greater than or equal to the number of lanes at the previous exit minus 1, if so, set the intersection matching state of the current waypoint to be outside the intersection, if not , then set the intersection matching state of the current waypoint as the matched exit intersection.
对于上述步骤401~403,为便于理解,下面以一个实际应用场景对步骤401~403中的内容进行详细说明。For the above steps 401-403, for ease of understanding, the content in steps 401-403 will be described in detail below using a practical application scenario.
在本应用场景中,为便于描述和理解,进行以下说明:路径数据包括STUB消息、SEGMENT消息、PROFILE SHORT消息和PROFILE LONG消息,对于这几个消息,上述内容有相关描述,此处不作赘述。offset属性表示里程值。匹配标识MatchFlag表示路口匹配状态,其中,MatchFlag=0,表示处于路口外;MatchFlag=1,表示已匹配入路口;MatchFlag=2表示已匹配特殊停止路口;MatchFlag=3表示已匹配出路口。属性1表征路点的路点属性,属性2表征路点的路口点属性,属性3表征路点的车道数目。其中,属性1的值等于1表示终点;等于2表示路上点;等于3表示入路口;等于4表示路口内点;等于5表示出路口。属性2的值等于0表示无属性;等于1表示路口直行。In this application scenario, for the convenience of description and understanding, the following explanations are made: path data includes STUB messages, SEGMENT messages, PROFILE SHORT messages, and PROFILE LONG messages. For these messages, the above content has related descriptions and will not be repeated here. The offset attribute represents the mileage value. The matching flag MatchFlag indicates the matching state of the intersection, wherein, MatchFlag=0 means that it is outside the intersection; MatchFlag=1 means that the intersection has been matched; MatchFlag=2 means that the special stop intersection has been matched; MatchFlag=3 means that the intersection has been matched. Attribute 1 represents the waypoint attribute of the waypoint, attribute 2 represents the intersection point attribute of the waypoint, and attribute 3 represents the number of lanes of the waypoint. Among them, the value of attribute 1 is equal to 1 to indicate the end point; equal to 2 to indicate the point on the road; equal to 3 to indicate the intersection; equal to 4 to indicate the inner point of the intersection; equal to 5 to indicate the exit. If the value of attribute 2 is equal to 0, it means no attribute; if it is equal to 1, it means go straight at the intersection.
在本应用场景中,当车辆决策系统接收到STUB消息、SEGMENT消息、PROFILE SHORT消息和PROFILE LONG消息之后,进行地理信息重构包括以下步骤流程:In this application scenario, after the vehicle decision-making system receives STUB messages, SEGMENT messages, PROFILE SHORT messages, and PROFILE LONG messages, the geographic information reconstruction includes the following steps:
步骤一、如果前一路点的匹配标志MatchFlag等于0:Step 1. If the matching flag MatchFlag of the previous point is equal to 0:
I.判断当前路点是否终点,如果是,则设置当前路点的属性1的值为1,且设置其属性2的值为0,设置当前路点的匹配标志MatchFlag为0。1. judge whether the current waypoint is an end point, if so, then set the value of attribute 1 of the current waypoint to 1, and set the value of its attribute 2 to 0, and set the matching flag MatchFlag of the current waypoint to be 0.
II.如果I不符合,将当前路点的offset属性与已接收的PROFILE SHORT入路口的offset属性比较,如果与某个PROFILE SHORT入路口的offset相等,并且在设定offset偏移范围内找到STUB,则表示当前路点是入路口,则设置当前路点的属性1的值为3,且设置其属性2等于对应STUB的路口属性。设置当前路点的匹配标志MatchFlag为1。II. If I does not match, compare the offset attribute of the current waypoint with the offset attribute of the received PROFILE SHORT entry, if it is equal to the offset of a certain PROFILE SHORT entry, and find STUB within the set offset offset range , which means that the current waypoint is an intersection, then set the value of attribute 1 of the current waypoint to 3, and set its attribute 2 equal to the intersection attribute of the corresponding STUB. Set the matching flag MatchFlag of the current waypoint to 1.
III.如果I和II都不符合,则将offset属性与已接收的PROFILE SHORT的非路口红绿灯、独立停止线、独立斑马线的offset属性比较,如果相等,则表示当前路点为特殊路口,则设置当前路点的属性1的值为3,且设置其属性2的值为1,设置当前路点的匹配标志MatchFlag为2。III. If I and II do not match, compare the offset attribute with the offset attribute of the received PROFILE SHORT non-intersection traffic lights, independent stop lines, and independent zebra crossings. If they are equal, it means that the current waypoint is a special intersection, then set The value of attribute 1 of the current waypoint is 3, and the value of attribute 2 is set to 1, and the matching flag MatchFlag of the current waypoint is set to 2.
IV.如果I、II和III都不符合,则表示当前路点为普通的路上点,且设置当前路点的属性1的值为2,设置其属性2的值为0,设置当前路点的匹配标志MatchFlag为0。IV. If I, II and III do not match, it means that the current waypoint is an ordinary waypoint, and set the value of attribute 1 of the current waypoint to 2, set the value of attribute 2 to 0, and set the value of the current waypoint The matching flag MatchFlag is 0.
步骤二、如果前一路点的匹配标志MatchFlag等于1:Step 2. If the matching flag MatchFlag of the previous point is equal to 1:
I.判断当前路点是否终点,如果是,则设置当前路点的属性1的值为1,且设置其属性2的值为0。设置当前路点的匹配标志MatchFlag为0。I. Determine whether the current waypoint is an end point, if so, set the value of attribute 1 of the current waypoint to 1, and set the value of attribute 2 of the current waypoint to 0. Set the matching flag MatchFlag of the current waypoint to 0.
II.如果I不符合,将当前路点的offset属性与已接收的PROFILE SHORT出路口的offset属性比较,如果与某个PROFILE SHORT出路口的offset相等,则表示当前路点是出路口,则设置当前路点的属性1的值为5,且设置其属性2的值为0。设置当前路点的匹配标志MatchFlag为3。II. If I does not match, compare the offset attribute of the current waypoint with the offset attribute of the received PROFILE SHORT exit, if it is equal to the offset of a certain PROFILE SHORT exit, it means that the current waypoint is an exit, then set The value of attribute 1 of the current waypoint is 5, and the value of attribute 2 is set to 0. Set the matching flag MatchFlag of the current waypoint to 3.
III.如果I和II都不符合,则认为当前路点是路口内点,则设置当前路点的属性1的值为4,且设置其属性2的值为0。设置当前路点的匹配标志MatchFlag为1。III. If I and II do not match, the current waypoint is considered to be an intersection interior point, then set the value of attribute 1 of the current waypoint to 4, and set the value of attribute 2 to 0. Set the matching flag MatchFlag of the current waypoint to 1.
步骤三、如果前一路点的匹配标志MatchFlag等于2:Step 3. If the matching flag MatchFlag of the previous road point is equal to 2:
I.判断当前路点是否终点,如果是,则设置当前路点的属性1的值为1,且设置其属性2的值为0。设置当前路点的匹配标志MatchFlag为0。I. Determine whether the current waypoint is an end point, if so, set the value of attribute 1 of the current waypoint to 1, and set the value of attribute 2 of the current waypoint to 0. Set the matching flag MatchFlag of the current waypoint to 0.
II.如果I不符合,则将当前路点的offset属性与已接收的PROFILE SHORT入路口的offset属性比较,如果与某个PROFILE SHORT入路口的offset相等,,则表明当前路点存在新的入路口。但是通过前一路点的匹配标志MatchFlag=2可知,之前已有一个独立特征(如:非路口红绿灯、独立停止线、独立斑马线等),相当于在当前路点之前已存在一个入路口,因此无需再为当前路点设置入路口,则认为当前路点为路口内点,则设置当前路点的属性1的值为4,且设置其属性2的值为0。设置当前路点的匹配标志MatchFlag为1。II. If I does not match, then compare the offset attribute of the current waypoint with the offset attribute of the received PROFILE SHORT entry, if it is equal to the offset of a certain PROFILE SHORT entry, it indicates that there is a new entry in the current waypoint intersection. But by the matching flag MatchFlag=2 of the previous road point, it can be seen that there is an independent feature (such as: non-intersection traffic lights, independent stop lines, independent zebra crossings, etc.) before, which is equivalent to existing an entrance before the current road point, so no need Then set the intersection for the current waypoint, then the current waypoint is considered as the interior point of the intersection, then set the value of attribute 1 of the current waypoint to 4, and set the value of attribute 2 to 0. Set the matching flag MatchFlag of the current waypoint to 1.
III.如果I和II都不符合,则将当前路点的offset属性与已接收的PROFILE SHORT出路口的offset属性比较,如果与某个PROFILE SHORT出路口的offset相等,则表示当前路点是出路口,则设置当前路点的属性1的值为5,且设置其属性2的值为0。设置当前路点的匹配标志MatchFlag为3。III. If I and II do not match, then compare the offset attribute of the current waypoint with the offset attribute of the received PROFILE SHORT exit, if it is equal to the offset of a certain PROFILE SHORT exit, it means that the current waypoint is an exit intersection, set the value of attribute 1 of the current waypoint to 5, and set the value of attribute 2 to 0. Set the matching flag MatchFlag of the current waypoint to 3.
IV.如果I、II和III都不符合,则确定当前路点作为之前独立特征(非路口红绿灯、独立停止线、独立斑马线等)的配对出路口,则设置当前路点的属性1的值为5,且设置其属性2的值为0。设置当前路点的匹配标志MatchFlag为3。IV. If I, II and III do not match, then determine the current waypoint as the paired exit intersection of the previous independent features (non-intersection traffic lights, independent stop lines, independent zebra crossings, etc.), then set the value of attribute 1 of the current waypoint 5, and set the value of its attribute 2 to 0. Set the matching flag MatchFlag of the current waypoint to 3.
步骤四、如果前一路点的匹配标志MatchFlag等于3:Step 4. If the matching flag MatchFlag of the previous way point is equal to 3:
I.将当前路点的offset属性与前一路点的offset属性比较,如果相等,则表示当前路点为前一路点的出路口候补点,把当前路点的经度、纬度分别存入前一个出路口的候补点经纬度数组,且该前一个出路口的出路口候补点点数加1。当前一个出路口的候补点点数大于等于前一个出路口的车道数-1时,表明当前路点为该前一个出路口的最后一个出路口候补点,因此,设置当前路点的匹配标志MatchFlag为0,否则设置当前路点的匹配标志MatchFlag为3。I. Compare the offset attribute of the current waypoint with the offset attribute of the previous waypoint. If they are equal, it means that the current waypoint is the candidate exit point of the previous waypoint. Store the longitude and latitude of the current waypoint into the previous exit respectively. The longitude and latitude array of the candidate point of the intersection, and the point of the candidate point of the previous exit is increased by 1. When the number of candidate points of the previous exit is greater than or equal to the number of lanes of the previous exit -1, it indicates that the current waypoint is the last candidate point of the previous exit. Therefore, the matching flag MatchFlag of the current waypoint is set as 0, otherwise set the matching flag MatchFlag of the current waypoint to 3.
II.如果I不符合,则认为前一路点的匹配标志MatchFlag为0,跳转并执行步骤一。II. If I does not meet, it is considered that the matching flag MatchFlag of the previous way point is 0, jump and perform step one.
步骤五、将当前路点的offset属性与当前已接收到的SEGMENT消息的offset属性进行比较,找到offset属性与当前路点的offset属性相等的SEGMENT消息的车道数目参数,并将当前路点的属性3设为找到的该车道数目参数的车道数目。Step five, compare the offset attribute of the current waypoint with the offset attribute of the currently received SEGMENT message, find the lane number parameter of the SEGMENT message whose offset attribute is equal to the offset attribute of the current waypoint, and set the attribute of the current waypoint 3 is set to the number of lanes found for this number of lanes parameter.
步骤六、确定当前路点完成属性匹配。Step 6: Determine the current waypoint to complete attribute matching.
经过上述步骤一至步骤六,可以确定当前路点的路口匹配状态,并对当前路点进行相应的属性设置,然后,再获取下一个路点作为当前路点,则原来的当前路点成为前一路点。由于原来的当前路点的路口匹配状态(即MatchFlag的值)已经知道,因此可以作为新的当前路点进行属性匹配的依据。可见,反复执行上述步骤一至步骤六,可以完成已接收到的规划路径上所有路点的属性匹配,从而实现地理信息的重构。After the above steps 1 to 6, you can determine the intersection matching status of the current waypoint, and set the corresponding attributes for the current waypoint, and then get the next waypoint as the current waypoint, then the original current waypoint becomes the previous road point. Since the intersection matching state (that is, the value of MatchFlag) of the original current waypoint is already known, it can be used as a basis for attribute matching of the new current waypoint. It can be seen that by repeatedly performing the above steps 1 to 6, attribute matching of all waypoints on the received planned route can be completed, thereby realizing the reconstruction of geographical information.
需要说明的是,对于上述步骤一至步骤六中,关于当前路点是否终点的判断,offset属性表示导航仪发送的ADASIS数据距离起点的偏移量,非终点数据的路点的offset为0~8190,当接收到路点的offset为8191时,则可以认为该路点为终点。It should be noted that, for the judgment of whether the current waypoint is the end point in the above steps 1 to 6, the offset attribute indicates the offset of the ADASIS data sent by the navigator from the starting point, and the offset of the waypoint of the non-end point data is 0~8190 , when the offset of the received waypoint is 8191, the waypoint can be considered as the end point.
进一步地,本实施例中,如图9所示,在确定当前路点完成属性匹配之前,还可以包括Further, in this embodiment, as shown in FIG. 9 , before it is determined that the attribute matching of the current waypoint is completed, it may also include
901、检测各个所述自定义属性参数对应的里程值是否与所述当前路点的里程值相等,若是,则执行步骤902,若否,则继续检测;901. Detect whether the mileage value corresponding to each of the custom attribute parameters is equal to the mileage value of the current waypoint, if yes, execute step 902, and if not, continue detection;
902、将所述当前路点的自定义属性设为检测到的所述自定义属性参数的自定义属性。902. Set the custom attribute of the current waypoint as the detected custom attribute of the custom attribute parameter.
对于上述步骤901和步骤902,其中,所述预设附加属性参数可以包括自定义属性参数。在确定当前路点完成属性匹配之前,可以检测各个所述自定义属性参数对应的里程值是否与所述当前路点的里程值相等,若是,则表明检测到的自定义属性参数为当前路点的自定义属性。从而执行步骤902,对当前路点的自定义属性进行设置。For the above steps 901 and 902, the preset additional attribute parameters may include custom attribute parameters. Before determining that the current waypoint completes attribute matching, it can be detected whether the mileage value corresponding to each of the custom attribute parameters is equal to the mileage value of the current waypoint, if so, it indicates that the detected custom attribute parameter is the current waypoint custom properties for . Therefore, step 902 is executed to set the custom attribute of the current waypoint.
其中,上述步骤902可以包括:若检测到所述道路限速参数的里程值与所述当前路点的里程值相等,则将所述当前路点的限速属性设为检测到的所述道路限速参数的限速值;若检测到所述车道宽度参数的里程值与所述当前路点的里程值相等,则将所述当前路点的车道宽度属性设为检测到的所述车道宽度参数的宽度值。Wherein, the above step 902 may include: if it is detected that the mileage value of the road speed limit parameter is equal to the mileage value of the current waypoint, then setting the speed limit attribute of the current waypoint as the detected road The speed limit value of the speed limit parameter; if it is detected that the mileage value of the lane width parameter is equal to the mileage value of the current waypoint, then the lane width attribute of the current waypoint is set as the detected lane width The width value of the parameter.
具体地,该自定义属性参数还可以包括车道允许变道属性、车道编号、是否变道前终点等属性信息,在实际应用中可以根据需要进行设置,此处不作限定。Specifically, the custom attribute parameter may also include attribute information such as lane change allowed, lane number, whether to end before lane change, etc., which can be set according to needs in practical applications, and are not limited here.
由上述内容可知,本实施例中一种高精度地理信息重构方法,可以将高精度定位和高精度地图技术运用到无人驾驶汽车中,将导航精度提高到cm级,并在大量的地图信息中提取并重构出所需要的高精度地理信息,为无人驾驶汽车的无人驾驶提供可靠的导航信息。As can be seen from the above, a high-precision geographic information reconstruction method in this embodiment can apply high-precision positioning and high-precision map technology to unmanned vehicles, improve the navigation accuracy to cm level, and use it on a large number of maps Extract and reconstruct the required high-precision geographic information from the information, and provide reliable navigation information for the unmanned driving of unmanned vehicles.
上面主要描述了一种高精度地理信息重构方法,下面将对一种高精度地理信息重构装置进行详细描述。A method for reconstructing high-precision geographic information is mainly described above, and a device for reconstructing high-precision geographic information will be described in detail below.
图10示出了本发明实施例中一种高精度地理信息重构装置一个实施例结构图。Fig. 10 shows a structural diagram of an embodiment of a device for reconstructing high-precision geographic information in an embodiment of the present invention.
本实施例中,一种高精度地理信息重构装置,包括:In this embodiment, a high-precision geographic information reconstruction device includes:
路径数据接收模块101,用于接收当前导航任务规划的规划路径的路径数据,所述规划路径由连续的各个路点组成,所述路径数据包括所述规划路径上各个路点的属性参数;The route data receiving module 101 is used to receive the route data of the planned route planned by the current navigation task, the planned route is composed of consecutive way points, and the route data includes attribute parameters of each way point on the planned route;
解析缓存模块102,用于解析所述路径数据,得到并缓存所述路径数据中所述各个路点的属性参数以及与每个属性参数对应的里程值,所述属性参数包括路口属性参数、车道数目参数、预设附加属性参数和路点的经纬度参数中的至少一个;所述里程值为各个路点距离所述当前导航任务的起点的里程,所述预设附加属性参数包括入路口参数、独立特征参数和出路口参数中的至少一个;The parsing cache module 102 is used to parse the path data, obtain and cache the attribute parameters of each waypoint in the path data and the mileage value corresponding to each attribute parameter, the attribute parameters include intersection attribute parameters, lanes At least one of the number parameter, the preset additional attribute parameter and the latitude and longitude parameter of the waypoint; the mileage value is the mileage of each waypoint from the starting point of the current navigation task, and the preset additional attribute parameter includes an entry parameter, At least one of the independent feature parameter and the exit parameter;
属性匹配模块103,用于从所述起点开始依次从缓存中取出一个路点作为当前路点,并将所述当前路点与前一路点进行属性匹配,直至所述缓存中所有路点均完成属性匹配,所述前一路点为前一个取出的路点;The attribute matching module 103 is used to sequentially take out a waypoint from the cache as the current waypoint from the starting point, and perform attribute matching on the current waypoint and the previous waypoint until all the waypoints in the cache are completed Attribute matching, the previous waypoint is the previous taken out waypoint;
所述属性匹配模块103包括:The attribute matching module 103 includes:
路点属性确定单元1031,用于根据所述各个路点的属性参数中里程值与所述当前路点的里程值相等的所述预设附加属性参数和/或所述路口属性参数,以及所述前一路点的路口匹配状态确定所述当前路点的路点属性,所述路点属性包括终点、入路口、特殊路口、路上点、出路口、路口内点、配对出路口或出路口候补点中的一个,所述路口匹配状态包括处于路口外、已匹配入路口、已匹配特殊停止路口和已匹配出路口中的一个;The waypoint attribute determination unit 1031 is configured to use the preset additional attribute parameter and/or the intersection attribute parameter whose mileage value is equal to the mileage value of the current waypoint among the attribute parameters of each waypoint, and the The intersection matching state of the previous road point determines the road point attribute of the current way point, and the road point attribute includes an end point, an entry point, a special intersection, a point on the road, an exit point, an interior point at an intersection, a paired exit point, or a candidate for an exit point One of the points, the intersection matching state includes one of being outside the intersection, matching the intersection, matching the special stop intersection and matching the exit intersection;
属性参数设置单元1032,用于根据所述当前路点的路点属性设置所述当前路点的属性参数和路口匹配状态;An attribute parameter setting unit 1032, configured to set the attribute parameter and intersection matching state of the current waypoint according to the waypoint attribute of the current waypoint;
车道数目设置单元1033,用于根据所述当前路点的车道数目参数设置所述当前路点的车道数目的值。The lane number setting unit 1033 is configured to set the value of the lane number of the current waypoint according to the lane number parameter of the current waypoint.
进一步地,所述路点属性确定单元可以包括:Further, the waypoint attribute determining unit may include:
第一确定子单元,用于当前一路点的路口匹配状态为处于路口外时:若所述当前路点的里程值满足预设里程条件,则确定所述当前路点为终点;若存在对应里程值与所述当前路点的里程值相等的入路口参数,且在所述里程值相等的入路口参数的预设里程偏移范围内查找到路口属性参数,则确定所述当前路点为入路口;若存在对应里程值与所述当前路点的里程值相等的独立特征参数,则确定所述当前路点为特殊路口;反之,则确定所述当前路点为路上点;The first determining subunit is used when the intersection matching state of the current waypoint is outside the intersection: if the mileage value of the current waypoint satisfies the preset mileage condition, then determine that the current waypoint is the end point; if there is a corresponding mileage If the value of the entry parameter is equal to the mileage value of the current waypoint, and the intersection attribute parameter is found within the preset mileage offset range of the entry parameter with the same mileage value, then it is determined that the current waypoint is an entry point. intersection; if there is an independent characteristic parameter whose corresponding mileage value is equal to the mileage value of the current waypoint, then determine that the current waypoint is a special intersection; otherwise, determine that the current waypoint is a waypoint;
第二确定子单元,用于当前一路点的路口匹配状态为已匹配入路口时:若所述当前路点的里程值满足预设里程条件,则确定所述当前路点为终点;若存在对应里程值与所述当前路点的里程值相等的出路口参数,则确定所述当前路点为出路口;反之,则确定所述当前路点为路口内点;The second determining subunit is used when the intersection matching state of the current road point is a matched intersection: if the mileage value of the current way point satisfies the preset mileage condition, then determine that the current way point is the end point; if there is a corresponding The intersection parameter whose mileage value is equal to the mileage value of the current waypoint determines that the current waypoint is an intersection; otherwise, determines that the current waypoint is an intersection interior point;
第三确定子单元,用于当前一路点的路口匹配状态为已匹配特殊停止路口时:若所述当前路点的里程值满足预设里程条件,则确定所述当前路点为终点;若存在对应里程值与所述当前路点的里程值相等的入路口参数,则确定所述当前路点为路口内点;若存在对应里程值与所述当前路点的里程值相等的出路口参数,则确定所述当前路点为出路口;反之,则确定所述当前路点为配对出路口;The third determining subunit is used when the intersection matching state of the current road point is a matched special stop intersection: if the mileage value of the current way point meets the preset mileage condition, then determine that the current way point is the end point; if there is If the corresponding mileage value is equal to the entry parameter of the mileage value of the current waypoint, then the current waypoint is determined to be an intersection interior point; if there is an exit parameter whose corresponding mileage value is equal to the mileage value of the current waypoint, Then determine that the current waypoint is an exit; otherwise, determine that the current waypoint is a matching exit;
第四确定子单元,用于当前一路点的路口匹配状态为已匹配出路口时:若所述当前路点的里程值与前一路点的里程值相等,则确定所述当前路点为出路口候补点;若所述当前路点的里程值与前一路点的里程值不相等,则跳转至所述当前一路点的路口匹配状态为处于路口外时的步骤。The fourth determining subunit is used when the intersection matching state of the current road point is a matched exit: if the mileage value of the current way point is equal to the mileage value of the previous road point, then determine that the current way point is an exit Alternate point: if the mileage value of the current waypoint is not equal to the mileage value of the previous waypoint, jump to the step when the intersection matching state of the current waypoint is outside the intersection.
进一步地,所述属性参数设置单元可以包括:Further, the attribute parameter setting unit may include:
第一设置子单元,用于若所述当前路点为终点,则将所述当前路点的路点属性设为终点,路口点属性设为无属性,路口匹配状态设为处于路口外;The first setting subunit is used to set the waypoint attribute of the current waypoint as the end point, set the intersection point attribute as no attribute, and set the intersection matching state as being outside the intersection if the current waypoint is the end point;
第二设置子单元,用于若所述当前路点为入路口,则将所述当前路点的路点属性设为入路口,路口点属性设为查找到的所述路口属性参数的路口属性,路口匹配状态设为已匹配入路口;The second setting subunit is used to set the waypoint attribute of the current waypoint as an intersection if the current waypoint is an intersection, and set the intersection point attribute as the intersection attribute of the found intersection attribute parameter , and the intersection matching state is set to the matched entry intersection;
第三设置子单元,用于若所述当前路点为特殊路口,则将所述当前路点的路点属性设为入路口,路口点属性设为路口直行,路口匹配状态设为已匹配特殊停止路口;The third setting subunit is used to set the waypoint attribute of the current waypoint as an intersection, the intersection point attribute as straight ahead at the intersection, and the matching state of the intersection as matched special if the current waypoint is a special intersection. stop intersection;
第四设置子单元,用于若所述当前路点为路上点,则将所述当前路点的路点属性设为路上点,路口点属性设为无属性,路口匹配状态设为处于路口外;The fourth setting subunit is used to set the waypoint attribute of the current waypoint as a waypoint if the current waypoint is a waypoint, set the intersection point attribute as no attribute, and set the intersection matching state as being outside the intersection if the current waypoint is a waypoint ;
第五设置子单元,用于若所述当前路点为出路口,则将所述当前路点的路点属性设为出路口,路口点属性设为无属性,路口匹配状态设为已匹配出路口;The fifth setting subunit is used to set the waypoint attribute of the current waypoint as an exit if the current waypoint is an exit, set the intersection point attribute as no attribute, and set the matching state of the intersection as matched exit. intersection;
第六设置子单元,用于若所述当前路点为路口内点,则将所述当前路点的路点属性设为路口内点,路口点属性设为无属性,路口匹配状态设为已匹配入路口;The sixth setting subunit is used to set the waypoint attribute of the current waypoint as an intersection interior point, the intersection point attribute as no attribute, and the intersection matching state as enabled if the current waypoint is an intersection interior point. Match entry;
第七设置子单元,用于若所述当前路点为配对出路口,则将所述当前路点的路点属性设为出路口,路口点属性设为无属性,路口匹配状态设为已匹配出路口;The seventh setting subunit is used to set the waypoint attribute of the current waypoint as an exit, the intersection point attribute as no attribute, and the intersection matching state as matched if the current waypoint is a paired exit. Exit;
第八设置子单元,用于若所述当前路点为出路口候补点,则将所述当前路点的经纬度参数存入至前一个出路口的候补点经纬度数组,且所述前一个出路口的候补点点数加1;判断所述前一个出路口的候补点点数是否大于或等于所述前一个出路口的车道数减1,若是,则将所述当前路点的路口匹配状态设为处于路口外,若否,则将所述当前路点的路口匹配状态设为已匹配出路口。The eighth setting subunit is used to store the latitude and longitude parameters of the current waypoint into the latitude and longitude array of candidate points of the previous exit if the current waypoint is a candidate exit point, and the previous exit Add 1 to the candidate points of the previous intersection; judge whether the candidate points of the previous exit are greater than or equal to the number of lanes of the previous exit minus 1, if so, set the intersection matching state of the current waypoint to be in Outside the intersection, if not, set the intersection matching status of the current waypoint as the matched exit intersection.
进一步地,所述预设附加属性参数还可以包括自定义属性参数;Further, the preset additional attribute parameters may also include custom attribute parameters;
所述高精度地理信息重构装置还可以包括:The high-precision geographic information reconstruction device may also include:
参数检测模块,用于检测各个所述自定义属性参数对应的里程值是否与所述当前路点的里程值相等;A parameter detection module, configured to detect whether the mileage value corresponding to each of the custom attribute parameters is equal to the mileage value of the current waypoint;
自定义属性设置模块,用于若检测到所述自定义属性参数对应的里程值与所述当前路点的里程值相等,则将所述当前路点的自定义属性设为检测到的所述自定义属性参数的自定义属性。The custom attribute setting module is used to set the custom attribute of the current waypoint as the detected Custom attributes for custom attribute parameters.
进一步地,自定义属性参数包括道路限速参数和车道宽度参数中的至少一个,所述自定义属性设置模块可以包括:Further, the custom attribute parameters include at least one of road speed limit parameters and lane width parameters, and the custom attribute setting module may include:
第一属性设置单元,用于若检测到所述道路限速参数的里程值与所述当前路点的里程值相等,则将所述当前路点的限速属性设为检测到的所述道路限速参数的限速值;The first attribute setting unit is configured to set the speed limit attribute of the current waypoint as the detected road if it is detected that the mileage value of the road speed limit parameter is equal to the mileage value of the current waypoint The speed limit value of the speed limit parameter;
第二属性设置单元,用于若检测到所述车道宽度参数的里程值与所述当前路点的里程值相等,则将所述当前路点的车道宽度属性设为检测到的所述车道宽度参数的宽度值。The second attribute setting unit is configured to set the lane width attribute of the current waypoint as the detected lane width if it is detected that the mileage value of the lane width parameter is equal to the mileage value of the current waypoint The width value of the parameter.
本发明实施例还提供了一种车辆决策系统,其包括图10对应实施例中描述的任意一种高精度地理信息重构装置。An embodiment of the present invention also provides a vehicle decision-making system, which includes any high-precision geographic information reconstruction device described in the embodiment corresponding to FIG. 10 .
图11是本发明一实施例提供的服务器的示意图。如图11所示,该实施例的服务器11包括:处理器110、存储器111以及存储在所述存储器111中并可在所述处理器110上运行的计算机程序112,例如高精度地理信息重构程序。所述处理器110执行所述计算机程序112时实现上述各个高精度地理信息重构方法实施例中的步骤,例如图3所示的步骤301至303。或者,所述处理器110执行所述计算机程序112时实现上述各装置实施例中各模块/单元的功能,例如图10所示模块101至103的功能。Fig. 11 is a schematic diagram of a server provided by an embodiment of the present invention. As shown in Figure 11, the server 11 of this embodiment includes: a processor 110, a memory 111, and a computer program 112 stored in the memory 111 and operable on the processor 110, such as high-precision geographic information reconstruction program. When the processor 110 executes the computer program 112 , the steps in the above-mentioned embodiments of the high-precision geographic information reconstruction method are implemented, such as steps 301 to 303 shown in FIG. 3 . Alternatively, when the processor 110 executes the computer program 112, functions of the modules/units in the above-mentioned device embodiments, such as the functions of the modules 101 to 103 shown in FIG. 10 , are realized.
示例性的,所述计算机程序112可以被分割成一个或多个模块/单元,所述一个或者多个模块/单元被存储在所述存储器111中,并由所述处理器110执行,以完成本发明。所述一个或多个模块/单元可以是能够完成特定功能的一系列计算机程序指令段,该指令段用于描述所述计算机程序112在所述服务器11中的执行过程。Exemplarily, the computer program 112 can be divided into one or more modules/units, and the one or more modules/units are stored in the memory 111 and executed by the processor 110 to complete this invention. The one or more modules/units may be a series of computer program instruction segments capable of accomplishing specific functions, and the instruction segments are used to describe the execution process of the computer program 112 in the server 11 .
所述服务器11可以是本地服务器、云端服务器等计算设备。所述服务器可包括,但不仅限于,处理器110、存储器111。本领域技术人员可以理解,图11仅仅是服务器11的示例,并不构成对服务器11的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件,例如所述服务器还可以包括输入输出设备、网络接入设备、总线等。The server 11 may be a computing device such as a local server or a cloud server. The server may include, but not limited to, a processor 110 and a memory 111 . Those skilled in the art can understand that FIG. 11 is only an example of the server 11, and does not constitute a limitation to the server 11. It may include more or less components than those shown in the illustration, or combine certain components, or different components, such as The server may also include input and output devices, network access devices, buses, and the like.
所述处理器110可以是中央处理单元(Central Processing Unit,CPU),还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The processor 110 may be a central processing unit (Central Processing Unit, CPU), and may also be other general-purpose processors, a digital signal processor (Digital Signal Processor, DSP), an application specific integrated circuit (Application Specific Integrated Circuit, ASIC), Off-the-shelf programmable gate array (Field-Programmable Gate Array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.
所述存储器111可以是所述服务器11的内部存储单元,例如服务器11的硬盘或内存。所述存储器111也可以是所述服务器11的外部存储设备,例如所述服务器11上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步地,所述存储器111还可以既包括所述服务器11的内部存储单元也包括外部存储设备。所述存储器111用于存储所述计算机程序以及所述服务器所需的其他程序和数据。所述存储器111还可以用于暂时地存储已经输出或者将要输出的数据。The storage 111 may be an internal storage unit of the server 11 , such as a hard disk or memory of the server 11 . The memory 111 may also be an external storage device of the server 11, such as a plug-in hard disk equipped on the server 11, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, Flash Card (Flash Card), etc. Further, the storage 111 may also include both an internal storage unit of the server 11 and an external storage device. The memory 111 is used to store the computer program and other programs and data required by the server. The memory 111 can also be used to temporarily store data that has been output or will be output.
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统,装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working process of the system, device and unit described above may refer to the corresponding process in the foregoing method embodiments, which will not be repeated here.
在本申请所提供的几个实施例中,应该理解到,所揭露的系统,装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。In the several embodiments provided in this application, it should be understood that the disclosed system, apparatus and method may be implemented in other manners. For example, the apparatus embodiments described above are only illustrative. For example, the division of the units is only a logical function division. In actual implementation, there may be other division methods. For example, multiple units or components may be combined or Can be integrated into another system, or some features can be ignored, or not implemented. On the other hand, the shown or discussed mutual coupling or direct coupling or communication connection may be through some interfaces, indirect coupling or communication connection of devices or units, and may be in electrical, mechanical or other forms.
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。The units described as separate components may or may not be physically separated, and components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution in this embodiment.
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically alone, or two or more units may be integrated into one unit. The above-mentioned integrated units may be implemented in the form of hardware, or may be implemented in the form of software functional units.
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-OnlyMemory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。The integrated unit, if implemented in the form of a software functional unit and sold or used as an independent product, may be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention is essentially or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium , including several instructions for causing a computer device (which may be a personal computer, a server, or a network device, etc.) to execute all or part of the steps of the methods described in the various embodiments of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), magnetic disk or optical disk, and other media that can store program codes.
以上所述,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。As mentioned above, the above embodiments are only used to illustrate the technical solutions of the present invention, but not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand: The technical solutions described in the embodiments are modified, or some technical features thereof are equivalently replaced; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions in the embodiments of the present invention.
Claims (12)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710390962.6A CN107036619B (en) | 2017-05-27 | 2017-05-27 | High-precision geographic information reconstruction method, device, vehicle decision-making system and server |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710390962.6A CN107036619B (en) | 2017-05-27 | 2017-05-27 | High-precision geographic information reconstruction method, device, vehicle decision-making system and server |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107036619A CN107036619A (en) | 2017-08-11 |
CN107036619B true CN107036619B (en) | 2019-08-06 |
Family
ID=59540112
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710390962.6A Active CN107036619B (en) | 2017-05-27 | 2017-05-27 | High-precision geographic information reconstruction method, device, vehicle decision-making system and server |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107036619B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107909187B (en) * | 2017-10-19 | 2021-06-25 | 东南大学 | A method for quickly matching bus stops and road sections in electronic maps |
CN108225364B (en) * | 2018-01-04 | 2021-07-06 | 吉林大学 | A system and method for driving task decision-making of an unmanned vehicle |
CN114549831B (en) * | 2022-01-10 | 2024-09-24 | 清华大学 | Map waypoint segmentation method and device for predictive cruise system |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1864260A2 (en) * | 2005-03-04 | 2007-12-12 | Alain Rey | Method for image reconstruction in a vector graphic |
CN101196404A (en) * | 2006-12-08 | 2008-06-11 | 高德软件有限公司 | Navigation electronic map display equipment |
CN101359434A (en) * | 2008-09-17 | 2009-02-04 | 覃征 | Process for constructing road net model for traffic navigation system and traffic emulation system |
CN105320664A (en) * | 2014-06-12 | 2016-02-10 | 北京四维图新科技股份有限公司 | Method and device for modifying electronic map relational data |
CN105675000A (en) * | 2016-01-15 | 2016-06-15 | 武汉光庭信息技术股份有限公司 | Lane-level path planning method and system based on high precision map |
CN106289296A (en) * | 2016-09-05 | 2017-01-04 | 广州极飞科技有限公司 | A kind of method and apparatus of road guide |
CN106441319A (en) * | 2016-09-23 | 2017-02-22 | 中国科学院合肥物质科学研究院 | A system and method for generating a lane-level navigation map of an unmanned vehicle |
CN106537091A (en) * | 2014-03-07 | 2017-03-22 | 通腾导航技术股份有限公司 | Reconstructing routes using electronic map data |
-
2017
- 2017-05-27 CN CN201710390962.6A patent/CN107036619B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1864260A2 (en) * | 2005-03-04 | 2007-12-12 | Alain Rey | Method for image reconstruction in a vector graphic |
CN101196404A (en) * | 2006-12-08 | 2008-06-11 | 高德软件有限公司 | Navigation electronic map display equipment |
CN101359434A (en) * | 2008-09-17 | 2009-02-04 | 覃征 | Process for constructing road net model for traffic navigation system and traffic emulation system |
CN106537091A (en) * | 2014-03-07 | 2017-03-22 | 通腾导航技术股份有限公司 | Reconstructing routes using electronic map data |
CN105320664A (en) * | 2014-06-12 | 2016-02-10 | 北京四维图新科技股份有限公司 | Method and device for modifying electronic map relational data |
CN105675000A (en) * | 2016-01-15 | 2016-06-15 | 武汉光庭信息技术股份有限公司 | Lane-level path planning method and system based on high precision map |
CN106289296A (en) * | 2016-09-05 | 2017-01-04 | 广州极飞科技有限公司 | A kind of method and apparatus of road guide |
CN106441319A (en) * | 2016-09-23 | 2017-02-22 | 中国科学院合肥物质科学研究院 | A system and method for generating a lane-level navigation map of an unmanned vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN107036619A (en) | 2017-08-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109540162B (en) | ADAS map data processing method, ADAS map data acquisition device and vehicle-mounted equipment | |
US11192558B2 (en) | Method, apparatus, and system for providing road curvature data | |
US10017111B2 (en) | Driver assistance system and method for avoiding collisions | |
CN108922173B (en) | Vehicle deviation detection method and device | |
US9933269B2 (en) | Midpoint-based map-agnostic navigation routing | |
US10317222B2 (en) | Decision-based map-agnostic navigation routing | |
US10922963B2 (en) | Vehicle information processing apparatus and vehicle information processing program | |
EP3443302B1 (en) | Intersection map message creation for vehicle communication | |
US20190279502A1 (en) | Method, apparatus, and system for detecting a merge lane traffic jam | |
US20130179056A1 (en) | System for Constructing a Spanning Forest in a Vehicular Network | |
WO2018018940A1 (en) | Vehicle positioning method and apparatus, terminal, and computer storage medium | |
CN117290456A (en) | Method, apparatus and computer readable storage medium for enhancing path data | |
US10588009B2 (en) | PSM message-based device discovery for a vehicular mesh network | |
CN107036619B (en) | High-precision geographic information reconstruction method, device, vehicle decision-making system and server | |
US10899348B2 (en) | Method, apparatus and computer program product for associating map objects with road links | |
US20200398856A1 (en) | Method, apparatus, and system for providing road curvature data | |
CN115294764B (en) | Crosswalk area determination method, crosswalk area determination device, crosswalk area determination equipment and automatic driving vehicle | |
CN116086477B (en) | Partial path information generation method, device, equipment and computer-readable medium | |
CN110726414B (en) | Method and apparatus for outputting information | |
CN114708742B (en) | Signal lamp data generation method and device, electronic equipment and storage medium | |
US20250209907A1 (en) | Method, apparatus and computer program product for intelligent traffic data processing | |
US11837092B2 (en) | Driving assistance apparatus and vehicle | |
US20240192018A1 (en) | System and method for virtual lane generation | |
EP4328886A1 (en) | Information processing device, information processing system, and information processing method | |
CN114325787A (en) | Method, device and computer-readable storage medium for determining electronic fence of vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |