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.

CN118936502APending Publication Date: 2024-11-12NORTHWEST ELECTROMECHANICAL ENG RES INST
View PDF 0 Cites 0 Cited by

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
    Figure CN118936502A_ABST
Patent Text Reader

Abstract

The invention discloses an unmanned vehicle positioning and path planning method based on RTK and an online map, and the method comprises the steps: setting a coordinate origin and a coordinate axis orientation, building a map coordinate system for autonomous navigation, taking a UTM coordinate as an intermediate value, completing the conversion from the longitude and latitude of vehicle-mounted RTK equipment to the coordinate value under the map coordinate system, and carrying out the positioning and path planning of an unmanned vehicle. An online map API is called to complete path planning from a vehicle position to a navigation target point, path point sampling and coordinate conversion are completed at a certain resolution, whether a path is available or not is judged according to the number of path points, and a global path available for autonomous navigation under a map coordinate system is finally formed by adjusting the target point and the path resolution. The method is suitable for global path planning of the unmanned vehicle in a scene where a map cannot be constructed through the SLAM technology in advance, the application scene of autonomous navigation of the unmanned vehicle is expanded, and a safe and efficient optimal global path is provided.
Need to check novelty before this filing date? Find Prior Art

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.