Unmanned vehicle positioning and path planning method based on RTK and online map
Through RTK technology and online map interface, the positioning and path planning problems of unmanned vehicles in the scenario where maps cannot be pre-built, high-precision pose calculation and global path planning are realized, ensuring that unmanned vehicles are in dynamic environments Efficient navigation.
Patent Information
- Application Number
- CN202411066913.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-06
- Publication Date
- 2024-11-12
Smart Images

Figure CN118936502A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of autonomous navigation technology, and relates to an unmanned vehicle positioning and global path planning method based on real-time kinematic measurement (RTK) and an online map interface in an application scenario where a map cannot be built in advance. More specifically, it relates to an unmanned vehicle positioning and path planning method based on RTK and an online map. Background Art
[0002] In the autonomous navigation technology of unmanned vehicles, positioning and global path planning are key technologies for achieving efficient and safe driving. Traditional positioning and global path planning methods often rely on environmental maps pre-built by SLAM technology, complete the positioning of the unmanned vehicle in the map coordinate system through point cloud matching, and use map data to calculate and make decisions on the path. However, in large open outdoor scenes, due to the lack of reference objects, it is difficult to establish a reliable global map and complete accurate positioning and path planning based on SLAM technology, and in many practical application scenarios, there is no condition for pre-building maps, such as field exploration, emergency rescue, military operations, etc. In the above scenarios, RTK has ultra-high precision positioning and orientation capabilities, and online maps can obtain the latest environmental and road information in real time. Therefore, the rational use of RTK technology and online maps can dynamically plan the optimal global path in the specified coordinate system of the unmanned vehicle in scenarios where maps cannot be pre-built, for subsequent local path planning. Summary of the invention
[0003] The technical problem to be solved by the present invention is to accurately locate and plan the global path of an unmanned vehicle in a specified map coordinate system when a map cannot be constructed in advance by SLAM technology. In order to solve the above problem, the present invention provides an unmanned vehicle positioning and path planning method based on RTK and online maps, which includes the following steps:
[0004] Step 1: Set the latitude and longitude of the origin of the map coordinate system and convert it to UTM coordinates, and set the angle between the x-axis of the map coordinate system and the east direction;
[0005] Step 2: Read the longitude and latitude output by the vehicle-mounted RTK, calculate the position of the unmanned vehicle in the map coordinate system, and complete the vehicle positioning;
[0006] Step 3: Use the positioning result and the navigation target point as the starting point and the end point respectively to call the navigation API of the online map, obtain the returned global path planning result, and parse out the global path consisting of a series of longitude and latitude coordinates;
[0007] Step 4: Sample from the planning results according to the resolution of the global path planning and delete points that are too close;
[0008] Step 5: Convert the sampled path points to the map coordinate system in sequence to form a global path in the set map coordinate system;
[0009] Step 6: Determine whether the global path is available: whether the number of path points is not less than 3;
[0010] Step 7: If the judgment is true, the current global path is output as the global path available for the final autonomous navigation; otherwise, the navigation target point and the global path resolution are adjusted, and the process goes to step 3.
[0011] Beneficial effects of the present invention:
[0012] When a map cannot be built in advance, the present invention can use RTK to complete high-precision pose calculation of the unmanned vehicle in a specified map coordinate system, obtain the latest environment and road information by calling the online map interface, obtain the optimal global path of the unmanned vehicle and complete the coordinate conversion. BRIEF DESCRIPTION OF THE DRAWINGS
[0013] Figure 1 The present invention is a flow chart of a method for positioning and path planning of an unmanned vehicle based on RTK and online maps. DETAILED DESCRIPTION
[0014] The present invention is further described below in conjunction with the accompanying drawings and examples so that those skilled in the art can better understand the present invention and implement it, but the examples are not intended to limit the present invention.
[0015] like Figure 1 As shown, a method for positioning and path planning of an unmanned vehicle based on RTK and online maps includes the following steps:
[0016] Step 1: Set the latitude and longitude of the origin of the map coordinate system and convert to UTM coordinates x UTM0 ,y UTM0 , set the angle α between the x-axis of the map coordinate system and the east direction, where α is in the range of [-π,π] and is positive toward the north.
[0017] Step 2: Read the latitude and longitude of the unmanned vehicle output by RTK and convert it to UTM coordinates x UTM ,y UTM , the position of the unmanned vehicle in the map coordinate system is calculated by the following formula:
[0018]
[0019] in, x and y are the coordinates of the unmanned vehicle in the map coordinate system.
[0020] Step 3: Use the positioning result and the navigation target point as the starting point and the end point respectively, call the Tiandi Map Navigation API published by the Ministry of Natural Resources, and obtain the returned global path planning result consisting of n position points Path = {position1, position2, ..., position n}, where position i =(lon i ,lat i ),lon i ,lat i are the longitude and latitude of the i-th point respectively.
[0021] Step 4: According to the set path resolution resolution, start traversing from i=1 (1≤i≤n-1), calculate the distance l between the i-th point and the i+1-th point. If l<resolution, delete the i+1-th point, and finally get the sampled global path Path composed of m points (1≤m≤n). s ={position1,position2,...,position m}.
[0022] Step 5: For the point position on the sampled global path i , convert it to UTM coordinates and then use the formula in step 2 to convert it to a point in the specified map coordinate system i =(x i ,y i ), forming the global path Path map ={point1,point2,...,point m}.
[0023] Step 6: Determine whether the global path is available: whether the number of path points is not less than 3, that is, whether m≥3 is true.
[0024] Step 7: If the judgment is true, the current global path is output as the global path available for the final autonomous navigation; otherwise, the navigation target point and the global path resolution are adjusted, and the process goes to step 3.
Claims
1. A method for positioning and path planning of an unmanned vehicle based on RTK and online maps, characterized in that: It includes the following steps: Step 1: Set the latitude and longitude of the origin of the map coordinate system and convert to UTM coordinates Set the angle α between the x-axis of the map coordinate system and the east direction, where α is in the range [-π,π] and is positive toward the north. Step 2: Read the latitude and longitude of the unmanned vehicle output by RTK and convert it to UTM coordinates x UTM ,y UTM , the position of the unmanned vehicle in the map coordinate system is calculated by the following formula: in, x and y are the coordinates of the unmanned vehicle in the map coordinate system; Step 3: Use the positioning result and the navigation target point as the starting point and the end point respectively, call the Tiandi Map Navigation API published by the Ministry of Natural Resources, and obtain the returned global path planning result consisting of n position points Path = {position1, position2, ..., position n }, where position i =(lon i ,lat i ),lon i ,lat i are the longitude and latitude of the i-th point respectively; Step 4: According to the set path resolution resolution, start traversing from i=1 (1≤i≤n-1), calculate the distance l between the i-th point and the i+1-th point. If l<resolution, delete the i+1-th point, and finally get the sampled global path Path composed of m points (1≤m≤n). s ={position1,position2,...,position m }; Step 5: For the point position on the sampled global path i , convert it to UTM coordinates and then use the formula in step 2 to convert it to a point in the specified map coordinate system i =(x i ,y i ), forming the global path Path map ={point1,point2,...,point m }; Step 6: Determine whether the global path is available: whether the number of path points is not less than 3, that is, whether m≥3 is true; Step 7: If the judgment is true, the current global path is output as the global path available for the final autonomous navigation; otherwise, the navigation target point and the global path resolution are adjusted, and the process goes to step 3.
