CN112154355B - High-precision map positioning method, system, platform and computer readable storage medium - Google Patents

High-precision map positioning method, system, platform and computer readable storage medium Download PDF

Info

Publication number
CN112154355B
CN112154355B CN201980032943.3A CN201980032943A CN112154355B CN 112154355 B CN112154355 B CN 112154355B CN 201980032943 A CN201980032943 A CN 201980032943A CN 112154355 B CN112154355 B CN 112154355B
Authority
CN
China
Prior art keywords
positioning result
candidate
determining
matching degree
height
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
Application number
CN201980032943.3A
Other languages
Chinese (zh)
Other versions
CN112154355A (en
Inventor
钟阳
周游
孙路
江灿森
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
SZ DJI Technology Co Ltd
Original Assignee
SZ DJI Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by SZ DJI Technology Co Ltd filed Critical SZ DJI Technology Co Ltd
Publication of CN112154355A publication Critical patent/CN112154355A/en
Application granted granted Critical
Publication of CN112154355B publication Critical patent/CN112154355B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/89Lidar systems specially adapted for specific applications for mapping or imaging
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching
    • G01C21/32Structuring or formatting of map data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles

Abstract

A high-precision map positioning method, system, platform and computer readable storage medium, the method comprising: acquiring an offline high-precision map and establishing an online point cloud map; rasterizing the online point cloud map to obtain a plurality of online grid maps; and positioning the movable platform according to the height intervals in the online grid maps and the height intervals in the offline high-precision map. The method improves the positioning accuracy.

Description

High-precision map positioning method, system, platform and computer readable storage medium
Technical Field
The present disclosure relates to the field of high-precision maps, and in particular, to a high-precision map positioning method, system, platform, and computer readable storage medium.
Background
With the development of map technology, high-precision maps are beginning to be used in more and more fields. In general, the high-precision map positioning is to obtain the surrounding environment and obtain some feature information of the surrounding environment through a sensor carried by the movable platform, and then match the feature information with the feature information in the high-precision map, so as to obtain the positioning of the movable platform in the high-precision map.
However, because the feature matching is relatively dependent on the information richness of the surrounding environment, the situation that the positioning is impossible can occur in a scene with sparse features or lack of obvious features; and false match results may occur for the presence of repetitive features in some circumstances. Therefore, how to improve the accuracy and stability of the high-precision map positioning result is a problem to be solved at present.
Disclosure of Invention
Based on the above, the application provides a high-precision map positioning method, a system, a platform and a computer readable storage medium, which aim to improve the accuracy and stability of a high-precision map positioning result.
In a first aspect, the present application provides a high-precision map positioning method, including:
acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises a plurality of first altitude sections;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises a plurality of second height sections;
And positioning the movable platform according to a plurality of first height intervals in the off-line high-precision map and a plurality of second height intervals in the on-line grid map, which correspond to each candidate positioning result, so as to obtain a first positioning result of the movable platform.
In a second aspect, the present application further provides a high-precision map positioning method, including:
acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises an offline complete height layer and an offline non-ground height layer;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises an online complete height layer and an online non-ground height layer;
positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer which correspond to each candidate positioning result respectively to obtain a first positioning result; and
positioning the movable platform according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result respectively to obtain a second positioning result;
And determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
In a third aspect, the present application also provides a driving system comprising a lidar, a memory, and a processor; the memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises a plurality of first altitude sections;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises a plurality of second height sections;
and positioning the movable platform according to a plurality of second height intervals in the online grid map and a plurality of first height intervals in the offline high-precision map, which correspond to each candidate positioning result, so as to obtain a first positioning result of the movable platform.
In a fourth aspect, the present application also provides a driving system comprising a lidar, a memory, and a processor; the memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises an off-line complete height layer and an off-line non-ground height layer;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises an online complete height layer and an online non-ground height layer;
positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer which correspond to each candidate positioning result respectively to obtain a first positioning result; and
positioning the movable platform according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result respectively to obtain a second positioning result;
And determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
In a fifth aspect, the present application also provides a mobile platform comprising a lidar, a memory, and a processor; the memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises a plurality of first altitude sections;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises a plurality of second height sections;
and positioning the movable platform according to a plurality of second height intervals in the online grid map and a plurality of first height intervals in the offline high-precision map, which correspond to each candidate positioning result, so as to obtain a first positioning result of the movable platform.
In a sixth aspect, the present application also provides a mobile platform comprising a lidar, a memory, and a processor; the memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises an off-line complete height layer and an off-line non-ground height layer;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises an online complete height layer and an online non-ground height layer;
positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer which correspond to each candidate positioning result respectively to obtain a first positioning result; and
positioning the movable platform according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result respectively to obtain a second positioning result;
And determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
In a seventh aspect, the present application also provides a computer readable storage medium storing a computer program which, when executed by a processor, causes the processor to implement the high precision map positioning method as described above.
The embodiment of the application provides a high-precision map positioning method, a system, a platform and a computer readable storage medium, wherein an online point cloud map is subjected to rasterization processing through each candidate positioning result in a candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, and a movable platform is positioned through a plurality of height sections in an offline high-precision map and a plurality of height sections in each online grid map, so that the movable platform can be positioned under the scene of sparse characteristics or lack of obvious characteristics, and the accuracy and stability of the high-precision map positioning result can be improved.
It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the application.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings needed in the description of the embodiments will be briefly introduced below, and it is obvious that the drawings in the following description are some embodiments of the present application, and other drawings may be obtained according to these drawings without inventive effort for a person skilled in the art.
FIG. 1 is a schematic flow chart of the steps of a high-precision map positioning method according to an embodiment of the present application;
FIG. 2 is a schematic flow chart of sub-steps of the high precision map positioning method of FIG. 1;
FIG. 3 is a schematic flow chart of steps of another high-precision map positioning method according to an embodiment of the present application;
FIG. 4 is a schematic flow chart of sub-steps of the high precision map positioning method of FIG. 3;
FIG. 5 is a schematic flow chart of steps of another high-precision map positioning method according to an embodiment of the present application;
FIG. 6 is a schematic flow chart of steps of another high-precision map positioning method according to an embodiment of the present application;
FIG. 7 is a schematic block diagram of a steering system according to an embodiment of the present application;
fig. 8 is a schematic block diagram of a movable platform according to an embodiment of the present application.
Detailed Description
The following description of the embodiments of the present application will be made clearly and fully with reference to the accompanying drawings, in which it is evident that the embodiments described are some, but not all, of the embodiments of the present application. All other embodiments, which can be made by one of ordinary skill in the art without undue burden from the present disclosure, are within the scope of the present disclosure.
The flow diagrams depicted in the figures are merely illustrative and not necessarily all of the elements and operations/steps are included or performed in the order described. For example, some operations/steps may be further divided, combined, or partially combined, so that the order of actual execution may be changed according to actual situations.
Some embodiments of the present application are described in detail below with reference to the accompanying drawings. The following embodiments and features of the embodiments may be combined with each other without conflict.
Referring to fig. 1, fig. 1 is a schematic flowchart illustrating steps of a high-precision map positioning method according to an embodiment of the present application. The high-precision map positioning method can be applied to a movable platform or a driving system. The movable platform comprises a vehicle and an aircraft, the aircraft comprises an unmanned aerial vehicle and an unmanned aerial vehicle, the vehicle comprises a piloted vehicle, an unmanned vehicle and the like, and the unmanned aerial vehicle comprises a rotor type unmanned aerial vehicle, such as a four-rotor unmanned aerial vehicle, a six-rotor unmanned aerial vehicle and an eight-rotor unmanned aerial vehicle, a fixed-wing unmanned aerial vehicle, a combination of a rotary wing type unmanned aerial vehicle and a fixed-wing unmanned aerial vehicle, and the method is not limited herein.
Specifically, as shown in fig. 1, the high-precision map positioning method includes steps S101 to S103.
S101, acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises a plurality of first altitude sections.
The mobile platform acquires three-dimensional point cloud data of a traveling area through a high-precision laser radar, and processes the acquired three-dimensional point cloud data through a high-precision inertial navigation system and a point cloud registration algorithm to generate an off-line high-precision map. Or acquiring three-dimensional point cloud data of a traveling area through a high-precision laser radar, acquiring attitude data of a movable platform through an inertial measurement unit (Inertial Measurement Unit, IMU), acquiring position data of the movable platform through a global positioning system (Global Positioning System, GPS), correcting the acquired three-dimensional point cloud data based on the attitude data and the position data, and generating an off-line high-precision map based on the corrected three-dimensional point cloud data.
In the moving process of the movable platform, an off-line high-precision map is obtained, three-dimensional point cloud data of objects around the movable platform are collected in real time through a laser radar, and an on-line point cloud map is built based on the three-dimensional point cloud data collected in real time. The laser radar can determine three-dimensional point cloud data of the object based on the distance between the laser emission point and the reflection point of the emitted laser on the object and the emission direction of the laser emission point. The three-dimensional point cloud data of the object around the movable platform comprises data such as the distance between the object and the movable platform, the angle between the object and the movable platform, and the three-dimensional coordinates of the object.
The off-line high-precision map comprises a plurality of first height sections, wherein the height of each grid in the off-line high-precision map is respectively located in the corresponding first height section, the first height sections are obtained by dividing according to the height of the three-dimensional point cloud, the height interval values of the first height sections can be the same or different, and the height interval values are the height difference values of two end points of the height sections. It should be noted that the height interval value and the number of height intervals may be set based on actual situations, which is not particularly limited in this application. For example, when the height is 26 meters, the divided first height sections are respectively [0,1 ], [1,5 ], [5,9 ], [9, 14 ], [14, 18 ], [18, 22), and [22, 26] for a total of 7 first height sections.
S102, determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein the online grid maps comprise a plurality of second height sections.
The movable platform determines a candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result to obtain an online raster map corresponding to each candidate positioning result, namely, each candidate positioning result in the candidate positioning result set is marked in the online point cloud map, and the map area around each marked candidate positioning result is subjected to rasterization processing to obtain the raster map corresponding to each candidate positioning result.
The online grid map comprises a plurality of second height sections, the height of each grid in the online grid map is respectively located in the corresponding second height section, the second height sections are obtained by dividing according to the height of the three-dimensional point cloud, the height interval values of the second height sections can be identical or different, and the height interval values are the height difference values of two end points of the height sections. It should be noted that the height interval value and the number of height intervals may be set based on actual situations, which is not particularly limited in this application. For example, if the height is 26 meters, the divided second height sections are respectively [0,1 ], [1,5 ], [5,9 ], [9, 14 ], [14, 18 ], [18, 22), and [22, 26] for a total of 7 second height sections.
The number of the first height sections and the second height sections may be the same or different, and the first height sections and the second height sections have a corresponding relationship, and the two end points of the first height sections and the second height sections having the corresponding relationship are the same, which is not particularly limited in this application.
In one embodiment, the determination method of the candidate positioning result set is specifically: acquiring current position data and current posture data of a movable platform; determining a candidate position set according to the current position data; determining a candidate gesture set according to the current gesture data and a preset gesture error value; and determining a candidate positioning result set according to the candidate position set and the candidate gesture set. The current position data of the movable platform are position data output by a positioning system of the movable platform at the current moment, and the current posture data of the movable platform are posture data output by an inertial measurement unit of the movable platform at the current moment. The position data includes geographic position coordinates of the movable platform and the attitude data includes pitch, roll and yaw angles of the movable platform.
In one embodiment, the method for determining the candidate position set according to the current position data is specifically: the movable platform determines the change trend of the current position data and determines the candidate position set according to the change trend of the current position data. Specifically, the change trend can be represented by the gradient value and the gradient direction of the current position data, namely, a preset number of candidate gradient values are obtained along the gradient direction based on the gradient value in a preset unit gradient, and the position information corresponding to each candidate gradient value is determined, so that a candidate position set is determined. It should be noted that the preset unit gradients and the preset number may be set based on actual situations, which are not specifically limited in this application.
In an embodiment, the determination of the candidate pose set may be: calculating the difference value between the attitude angle in the current attitude data and the preset attitude error value, calculating the sum of the attitude angle in the current attitude data and the preset attitude error value, and then determining a candidate attitude set based on the difference value between the attitude angle in the current attitude data and the preset attitude error value and the sum of the attitude angle in the current attitude data and the preset attitude error value, namely taking the difference value between the attitude angle and the preset attitude error value as one endpoint and the sum of the attitude angle and the preset attitude error value as the other endpoint, so as to obtain a candidate attitude angle range, and acquiring a plurality of candidate attitude angles from the candidate attitude angle range by a preset unit attitude angle, thereby forming the candidate attitude set. It should be noted that the preset attitude error value and the unit attitude angle may be set based on actual situations, which are not specifically limited in this application. The candidate gesture set can be rapidly and accurately determined through the current gesture data and the preset gesture error value.
In an embodiment, the determination manner of the candidate gesture set may be: the movable platform determines the position coordinates of the movable platform in the off-line high-precision map according to the current position data, namely, the geographical position coordinates of the movable platform are obtained from the current position data, the geographical position coordinates are marked in the off-line high-precision map, then the position coordinates of objects around the geographical position coordinates in the off-line high-precision map are obtained, and the position coordinates of the movable platform in the off-line high-precision map are determined based on the position coordinates of the objects around the geographical position coordinates in the off-line high-precision map; and determining a candidate position set according to the position coordinates and the preset position error value. The candidate position set can be rapidly and accurately determined through the current position data and the preset position error value.
In one embodiment, the method for determining the candidate positioning result set according to the candidate position set and the candidate gesture set is specifically as follows: and the movable platform selects one candidate position from the candidate position set each time and combines with each candidate gesture in the candidate gesture set until each candidate position in the candidate position set is selected once, and each candidate positioning result obtained by combining is collected as a candidate positioning result set.
In an embodiment, the determination manner of the candidate positioning result set may be: and acquiring a historical positioning result of the movable platform, and determining a candidate positioning result set according to the historical positioning result. The historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time. It should be noted that the preset time may be set based on actual situations, which is not specifically limited in this application.
Specifically, a historical position coordinate and a historical attitude angle are obtained from the historical positioning result; carrying out derivative processing on the historical position coordinates to determine gradient values and gradient directions of the historical position coordinates, and determining a candidate position set according to the gradient values and the gradient directions, namely, obtaining a preset number of candidate gradient values along the gradient directions based on the gradient values in a preset unit gradient mode, and determining position information corresponding to each candidate gradient value, so as to determine the candidate position set;
calculating the difference value of the historical attitude angle and the preset attitude error value, and calculating the sum of the historical attitude angle and the preset attitude error value; taking the difference value of the historical attitude angle and the preset attitude error value as one endpoint, taking the sum of the historical attitude angle and the preset attitude error value as the other endpoint to obtain a candidate attitude angle range, and obtaining a plurality of candidate attitude angles from the candidate attitude angle range by a preset unit attitude angle so as to form a candidate attitude set;
And determining a candidate positioning result set according to the candidate position set and the candidate gesture set, namely, each candidate position is selected from the candidate position set and combined with each candidate gesture in the candidate gesture set each time until each candidate position in the candidate position set is selected once, and collecting each candidate positioning result obtained by combination as the candidate positioning result set. It should be noted that the preset unit gradients, the preset number, the preset attitude error values, and the preset unit attitude angles may be set based on actual situations, which are not specifically limited in this application.
And S103, positioning the movable platform according to a plurality of first height sections in the off-line high-precision map and a plurality of second height sections in the on-line grid map corresponding to each candidate positioning result, and obtaining a first positioning result of the movable platform.
After each candidate positioning result is determined by the movable platform, the movable platform is positioned according to a plurality of first height intervals in the offline high-precision map and a plurality of second height intervals in the online grid map corresponding to each candidate positioning result, and a first positioning result of the movable platform is obtained. The movable platform is positioned through a plurality of first height sections in the off-line high-precision map and a plurality of second height sections in each on-line grid map, so that an accurate positioning result can be obtained, and the accuracy and stability of the high-precision map positioning result can be improved.
In one embodiment, as shown in fig. 2, step S103 specifically includes: substeps S1031 to S1032.
S1031, determining the matching degree corresponding to each candidate positioning result according to a plurality of first altitude intervals in the offline high-precision map and a plurality of second altitude intervals in the online grid map corresponding to each candidate positioning result.
Specifically, determining a state comparison result between each second height section in each online grid map and a corresponding first height section in the offline high-precision map; and counting the number of second height sections with the state comparison result being the preset state comparison result in each online grid map, and taking the number of the second height sections with the state comparison result being the preset state comparison result in each online grid map as the matching degree corresponding to each candidate positioning result. The states of the first altitude section and the second altitude section comprise an occupied state and a non-occupied state, wherein three-dimensional point clouds exist in the first altitude section or the second altitude section in the occupied state, and three-dimensional point clouds do not exist in the first altitude section or the second altitude section in the non-occupied state. The state comparison results comprise states which are different, occupied and unoccupied. Optionally, the preset state comparison result is "all occupied state".
In an embodiment, the determining manner of the matching degree corresponding to each candidate positioning result is specifically: determining a state comparison result between each second height interval in each online non-ground height layer and a corresponding first height interval in each offline non-ground height layer; counting the number of second height intervals in which the state comparison result in each online non-ground height layer is a preset state comparison result; and determining the respective matching degree of each candidate positioning result according to the number of second height intervals, the state comparison result of which is a preset state comparison result, in each online non-ground height layer, namely, the number of second height intervals, the state comparison result of which is a preset state comparison result, in each online non-ground height layer is used as the respective matching degree of each candidate positioning result.
The off-line high-precision map comprises an off-line non-ground height layer, a plurality of first height sections are located on the off-line non-ground height layer, the on-line grid map comprises an on-line non-ground height layer, and a plurality of second height sections are located on the on-line non-ground height layer. The height of the end point of the first height section located on the off-line non-ground height layer and the height of the end point of the second height section located on the on-line non-ground height layer are greater than or equal to a set height threshold, and the height threshold can be set based on practical conditions, which is not particularly limited in the application. Optionally, the height threshold is 1 meter, the height of 26 meters is divided, and the obtained first height sections are [1, 5), [5, 9), [9, 14), [14, 18), [18, 22), and [22, 26] for a total of 6 second height sections, and the obtained second height sections are [1, 5), [5, 9), [9, 14), [14, 18), [18, 22 ], and [22, 26] for a total of 6 second height sections.
In an embodiment, the determining manner of the state comparison result between the first altitude section and the corresponding second altitude section specifically includes: acquiring first state identification information of each first height section in the offline non-ground height layer and acquiring second state identification information of each second height section of each online non-ground height layer; and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to the first state identification information and each second state identification information. The first state identification information includes a state identifier corresponding to each first altitude interval, the second state identification information includes a state identifier corresponding to each second altitude interval, and the state identifier and the state represented by the state identifier may be set based on actual situations, which is not limited in this application. Optionally, the altitude section with a state identifier of 0 is in a non-occupied state, and the altitude section with a state identifier of 1 is in an occupied state.
Specifically, the state identifier corresponding to each first height section in the first state identification information and the state identifier corresponding to the second height section in the second state identification information are logically and processed, so that a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer can be obtained. For example, the number of the first height sections and the number of the second height sections are 7, the first state identification information is 1010101, the second state identification information is 0111101, the 1010101 and 0111101 are logically and logically processed according to the bits to obtain the result 0010100, and the state comparison results between the 7 second height sections and the corresponding first height sections are respectively different in state, both in occupied state, different in state, both in occupied state and different in state.
S1032, selecting one candidate positioning result from the candidate positioning result set as a first positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
After determining the respective matching degree of each candidate positioning result, the movable platform determines a first positioning result of the movable platform from the candidate positioning result set according to the respective matching degree of each candidate positioning result, namely, the candidate positioning result with the highest matching degree is used as the first positioning result of the movable platform.
According to the high-precision map positioning method provided by the embodiment, the online point cloud map is subjected to rasterization processing through each candidate positioning result in the candidate positioning result set to obtain the grid map corresponding to each candidate positioning result, and the movable platform is positioned through a plurality of height sections in the offline high-precision map and a plurality of height sections in each online grid map, so that the movable platform can be positioned under the scene that some features are sparse or obvious features are lacking, and the accuracy and stability of the high-precision map positioning result can be improved.
Referring to fig. 3, fig. 3 is a schematic flowchart illustrating steps of another high-precision map positioning method according to an embodiment of the present application.
Specifically, as shown in fig. 3, the high-precision map positioning method includes steps S201 to S205.
S201, acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises a plurality of first altitude sections.
In the moving process of the movable platform, an off-line high-precision map is obtained, three-dimensional point cloud data of objects around the movable platform are collected in real time through a laser radar, and an on-line point cloud map is built based on the three-dimensional point cloud data collected in real time. The laser radar can determine three-dimensional point cloud data of the object based on the distance between the laser emission point and the reflection point of the emitted laser on the object and the emission direction of the laser emission point. The three-dimensional point cloud data of the object around the movable platform comprises data such as the distance between the object and the movable platform, the angle between the object and the movable platform, and the three-dimensional coordinates of the object.
S202, determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein the online grid maps comprise a plurality of second height sections.
The movable platform determines a candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result to obtain an online raster map corresponding to each candidate positioning result, namely, each candidate positioning result in the candidate positioning result set is marked in the online point cloud map, and the map area around each marked candidate positioning result is subjected to rasterization processing to obtain the raster map corresponding to each candidate positioning result.
S203, positioning the movable platform according to a plurality of first height sections in the off-line high-precision map and a plurality of second height sections in the on-line grid map corresponding to each candidate positioning result, and obtaining a first positioning result of the movable platform.
After each candidate positioning result is determined by the movable platform, the movable platform is positioned according to a plurality of first height intervals in the offline high-precision map and a plurality of second height intervals in the online grid map corresponding to each candidate positioning result, and a first positioning result of the movable platform is obtained. The movable platform is positioned through a plurality of first height sections in the off-line high-precision map and a plurality of second height sections in each on-line grid map, so that an accurate positioning result can be obtained, and the accuracy and stability of the high-precision map positioning result can be improved.
S204, positioning the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result, and obtaining a second positioning result of the movable platform.
And the movable platform positions the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result, and a second positioning result of the movable platform is obtained. The online grid map further comprises an online complete height layer, wherein the height of each grid in the online complete height layer is the average height of three-dimensional point clouds in the grids; the off-line high-precision map further comprises an off-line complete height layer, wherein the height of each grid in the off-line complete height layer is the average height of three-dimensional point clouds in the grids.
In one embodiment, as shown in fig. 4, step S204 specifically includes: substeps S2041 to S2042.
S2041, determining the matching degree of each candidate positioning result according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result.
Specifically, the movable platform acquires a local offline complete height layer corresponding to each online complete height layer from the offline complete height layers; and determining the loss cost between each online complete height layer and the corresponding local offline complete height layer according to the height of each grid in each online complete height layer and the height of each grid in the corresponding local offline complete height layer, and taking the loss cost between each online complete height layer and the corresponding local offline complete height layer as the respective corresponding matching degree of each candidate positioning result.
S2042, selecting one candidate positioning result from the candidate positioning result set as a second positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
After determining the respective matching degree of each candidate positioning result, selecting one candidate positioning result from the candidate positioning result set as a second positioning result of the movable platform according to the respective matching degree of each candidate positioning result.
The determining mode of the second positioning result specifically includes: the movable platform checks the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result; and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the minimum matching degree as a second positioning result of the movable platform. The verification mode of the candidate positioning result specifically comprises the following steps: determining whether the matching degree of the candidate positioning result is smaller than or equal to a preset matching degree threshold value, if the matching degree of the candidate positioning result is smaller than or equal to the preset matching degree threshold value, determining that the candidate positioning result passes the verification, and if the matching degree of the candidate positioning result is larger than the preset matching degree threshold value, determining that the candidate positioning result does not pass the verification. It should be noted that the above matching degree threshold may be set based on practical situations, which is not specifically limited in this application. And taking the candidate positioning result which passes the verification and corresponds to the minimum matching degree as a second positioning result of the movable platform, so that the accuracy of the positioning result can be further improved.
S205, fusing the first positioning result and the second positioning result to obtain a target positioning result of the movable platform.
After the first positioning result and the second positioning result of the movable platform are obtained, the movable platform fuses the first positioning result and the second positioning result to obtain a target positioning result of the movable platform. By fusing the two positioning results, the accuracy and stability of the positioning results can be further improved.
In an embodiment, the mobile platform obtains a degree of matching of the first positioning result and a degree of matching of the second positioning result; determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result; and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
The determining mode of the first weight coefficient and the second weight coefficient specifically comprises the following steps: normalizing the matching degree of the first positioning result and the matching degree of the second positioning result; determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result; determining a first weight coefficient of the first positioning result according to the processed matching degree and the total matching degree of the first positioning result; and determining a second weight coefficient of the second positioning result according to the processed matching degree and the processed total matching degree of the second positioning result.
The determination mode of the weight coefficient is specifically as follows: calculating the percentage of the matching degree of the processed first positioning result to the total matching degree, and taking the percentage as a first weight coefficient of the first positioning result; and calculating the percentage of the matching degree of the processed second positioning result to the total matching degree, and taking the percentage as a second weight coefficient of the second positioning result.
The method for determining the target positioning result specifically comprises the following steps: calculating the product of the first positioning result and the first weight coefficient to obtain a first weight positioning result; calculating the product of the second positioning result and the second weight coefficient to obtain a second weight positioning result; and calculating the sum of the first weight positioning result and the second weight positioning result, and taking the sum of the first weight positioning result and the second weight positioning result as a target positioning result of the movable platform.
According to the high-precision map positioning method provided by the embodiment, the online point cloud map is subjected to rasterization processing through each candidate positioning result in the candidate positioning result set to obtain the grid map corresponding to each candidate positioning result, the movable platform is positioned through a plurality of height intervals in the offline high-precision map and a plurality of height intervals in each online grid map, meanwhile, the movable platform is positioned through the online complete height map layer and the offline complete height map layer corresponding to each candidate positioning result, and finally, the accuracy and the stability of the positioning result can be further improved through fusion of the two positioning results.
Referring to fig. 5, fig. 5 is a schematic flowchart of steps of another high-precision map positioning method according to an embodiment of the present application.
Specifically, as shown in fig. 5, the high-precision map positioning method includes steps S301 to S305.
S301, acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises an offline complete height layer and an offline non-ground height layer.
The mobile platform acquires three-dimensional point cloud data of a traveling area through a high-precision laser radar, and processes the acquired three-dimensional point cloud data through a high-precision inertial navigation system and a point cloud registration algorithm to generate an off-line high-precision map.
In the moving process of the movable platform, an off-line high-precision map is obtained, three-dimensional point cloud data of objects around the movable platform are collected in real time through a laser radar, and an on-line point cloud map is built based on the three-dimensional point cloud data collected in real time. The laser radar can determine three-dimensional point cloud data of the object based on the distance between the laser emission point and the reflection point of the emitted laser on the object and the emission direction of the laser emission point. The three-dimensional point cloud data of the object around the movable platform comprises data such as the distance between the object and the movable platform, the angle between the object and the movable platform, and the three-dimensional coordinates of the object.
The off-line high-precision map comprises an off-line complete height map layer and an off-line non-ground height map layer, wherein the height of each grid in the off-line complete height map layer is the average value height of three-dimensional point clouds in the grids, the off-line non-ground height map layer comprises a plurality of height intervals, the height intervals are obtained by dividing according to the heights of the three-dimensional point clouds, the height interval values of the height intervals can be identical or different, and the height interval values are the height difference values of two end points of the height intervals. It should be noted that the height interval value and the number of height intervals may be set based on actual situations, which is not particularly limited in this application. For example, if the height is 26 meters, the height sections divided in the offline non-floor height map layer are respectively [1,5 ], [5,9 ], [9, 14 ], [14, 18 ], [18, 22), and [22, 26] for a total of 6 first height sections.
S302, determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises an online complete height layer and an online non-ground height layer.
The movable platform determines a candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result to obtain an online raster map corresponding to each candidate positioning result, namely, each candidate positioning result in the candidate positioning result set is marked in the online point cloud map, and the map area around each marked candidate positioning result is subjected to rasterization processing to obtain the raster map corresponding to each candidate positioning result.
The online grid map comprises an online complete height layer and an online non-ground height layer, the height of each grid in the online complete height layer is the average height of three-dimensional point clouds in the grids, the online non-ground height layer comprises a plurality of height intervals, the height intervals are obtained by dividing according to the heights of the three-dimensional point clouds, the height interval values of the height intervals can be identical or different, and the height interval values are the height difference values of two end points of the height intervals. It should be noted that the height interval value and the number of height intervals may be set based on actual situations, which is not particularly limited in this application.
In one embodiment, the determination method of the candidate positioning result set is specifically: acquiring current position data and current posture data of a movable platform; determining a candidate position set according to the current position data; determining a candidate gesture set according to the current gesture data and a preset gesture error value; and determining a candidate positioning result set according to the candidate position set and the candidate gesture set. The current position data of the movable platform are position data output by a positioning system of the movable platform at the current moment, and the current posture data of the movable platform are posture data output by an inertial measurement unit of the movable platform at the current moment. The position data includes geographic position coordinates of the movable platform and the attitude data includes pitch, roll and yaw angles of the movable platform.
In one embodiment, the candidate location set is determined by: the movable platform determines the change trend of the current position data and determines the candidate position set according to the change trend of the current position data. Specifically, the change trend can be represented by the gradient value and the gradient direction of the current position data, namely, a preset number of candidate gradient values are obtained along the gradient direction based on the gradient value in a preset unit gradient, and the position information corresponding to each candidate gradient value is determined, so that a candidate position set is determined. It should be noted that the preset unit gradients and the preset number may be set based on actual situations, which are not specifically limited in this application.
In an embodiment, the determination of the candidate pose set may be: calculating the difference value between the attitude angle in the current attitude data and the preset attitude error value, calculating the sum of the attitude angle in the current attitude data and the preset attitude error value, and then determining a candidate attitude set based on the difference value between the attitude angle in the current attitude data and the preset attitude error value and the sum of the attitude angle in the current attitude data and the preset attitude error value, namely taking the difference value between the attitude angle and the preset attitude error value as one endpoint and the sum of the attitude angle and the preset attitude error value as the other endpoint, so as to obtain a candidate attitude angle range, and acquiring a plurality of candidate attitude angles from the candidate attitude angle range by a preset unit attitude angle, thereby forming the candidate attitude set. It should be noted that the preset attitude error value and the unit attitude angle may be set based on actual situations, which are not specifically limited in this application. The candidate gesture set can be rapidly and accurately determined through the current gesture data and the preset gesture error value.
S303, positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer which correspond to each candidate positioning result, and obtaining a first positioning result.
And the movable platform positions the movable platform according to the online non-ground height layer and the offline non-ground height layer which are respectively corresponding to each candidate positioning result to obtain a first positioning result. Specifically, determining the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result; and determining a first positioning result from the candidate positioning result set according to the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result, namely taking the candidate positioning result with the highest matching degree as the first positioning result of the movable platform. And carrying out point cloud matching on the online non-ground height layer and the offline non-ground height layer which correspond to each candidate positioning result, and obtaining a positioning result of the movable platform according to the matching result, thereby improving the accuracy and stability of the positioning result.
The height interval in the off-line non-ground height layer is marked as a first height interval, and the height interval in the on-line non-ground height layer is marked as a second height interval, wherein the first height interval is the same as the corresponding second height interval.
In one embodiment, the movable platform determines a status comparison result between each second height section in each online non-ground height layer and a corresponding first height section in the offline non-ground height layer; counting the number of second height intervals in which the state comparison result in each online non-ground height layer is a preset state comparison result; and taking the number of second height intervals, the state comparison result of which is the preset state comparison result, in each online non-ground height layer as the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result. The states of the first altitude section and the second altitude section comprise an occupied state and a non-occupied state, wherein three-dimensional point clouds exist in the first altitude section or the second altitude section in the occupied state, and three-dimensional point clouds do not exist in the first altitude section or the second altitude section in the non-occupied state. The state comparison results comprise states which are different, occupied and unoccupied. Optionally, the preset state comparison result is "all occupied state".
In an embodiment, the determining manner of the state comparison result between the first altitude section and the corresponding second altitude section specifically includes: acquiring first state identification information of each first height section in the offline non-ground height layer and acquiring second state identification information of each second height section of each online non-ground height layer; and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to the first state identification information and each second state identification information. The first state identification information includes a state identifier corresponding to each first altitude interval, the second state identification information includes a state identifier corresponding to each second altitude interval, and the state identifier and the state represented by the state identifier may be set based on actual situations, which is not limited in this application. Optionally, the altitude section with a state identifier of 0 is in a non-occupied state, and the altitude section with a state identifier of 1 is in an occupied state.
Specifically, the state identifier corresponding to each first height section in the first state identification information and the state identifier corresponding to the second height section in the second state identification information are logically and processed, so that a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer can be obtained. For example, the number of the first height sections and the number of the second height sections are 7, the first state identification information is 1010101, the second state identification information is 0111101, the 1010101 and 0111101 are logically and logically processed according to the bits to obtain the result 0010100, and the state comparison results between the 7 second height sections and the corresponding first height sections are respectively different in state, both in occupied state, different in state, both in occupied state and different in state.
S304, positioning the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result, and obtaining a second positioning result.
And the movable platform positions the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result, and a second positioning result of the movable platform is obtained. Specifically, according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result, determining the matching degree of each candidate positioning result; and determining a second positioning result from the candidate positioning result set according to the matching degree corresponding to each candidate positioning result.
In one embodiment, the mobile platform obtains a local offline full-height layer corresponding to each online full-height layer from the offline full-height layers; and determining the loss cost between each online complete height layer and the corresponding local offline complete height layer according to the height of each grid in each online complete height layer and the height of each grid in the corresponding local offline complete height layer, and taking the loss cost between each online complete height layer and the corresponding local offline complete height layer as the respective corresponding matching degree of each candidate positioning result.
The determining mode of the second positioning result specifically includes: the movable platform checks the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result; and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the minimum matching degree as a second positioning result of the movable platform. The verification mode of the candidate positioning result specifically comprises the following steps: determining whether the matching degree of the candidate positioning result is smaller than or equal to a preset matching degree threshold value, if the matching degree of the candidate positioning result is smaller than or equal to the preset matching degree threshold value, determining that the candidate positioning result passes the verification, and if the matching degree of the candidate positioning result is larger than the preset matching degree threshold value, determining that the candidate positioning result does not pass the verification. It should be noted that the above matching degree threshold may be set based on practical situations, which is not specifically limited in this application. And taking the candidate positioning result which passes the verification and corresponds to the minimum matching degree as a second positioning result of the movable platform, so that the accuracy of the positioning result can be further improved.
S305, determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
After the first positioning result and the second positioning result of the movable platform are determined, determining a target positioning result of the movable platform according to the first positioning result and the second positioning result. By fusing the two positioning results, the accuracy and stability of the positioning results can be further improved.
In an embodiment, the mobile platform obtains a degree of matching of the first positioning result and a degree of matching of the second positioning result; determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result; and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
The determining mode of the first weight coefficient and the second weight coefficient specifically comprises the following steps: normalizing the matching degree of the first positioning result and the matching degree of the second positioning result; determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result; determining a first weight coefficient of the first positioning result according to the processed matching degree and the total matching degree of the first positioning result; and determining a second weight coefficient of the second positioning result according to the processed matching degree and the processed total matching degree of the second positioning result.
The determination mode of the weight coefficient is specifically as follows: calculating the percentage of the matching degree of the processed first positioning result to the total matching degree, and taking the percentage as a first weight coefficient of the first positioning result; and calculating the percentage of the matching degree of the processed second positioning result to the total matching degree, and taking the percentage as a second weight coefficient of the second positioning result.
The method for determining the target positioning result specifically comprises the following steps: calculating the product of the first positioning result and the first weight coefficient to obtain a first weight positioning result; calculating the product of the second positioning result and the second weight coefficient to obtain a second weight positioning result; and calculating the sum of the first weight positioning result and the second weight positioning result, and taking the sum of the first weight positioning result and the second weight positioning result as a target positioning result of the movable platform.
According to the high-precision map positioning method provided by the embodiment, each candidate positioning result in the candidate positioning result set is used for carrying out rasterization processing on the online point cloud map to obtain the grid map corresponding to each candidate positioning result, the movable platform is positioned through the offline non-ground height layer and the online non-ground height layer in each grid map to obtain one positioning result, meanwhile, the movable platform is positioned through the offline complete height layer and the online complete height layer in each grid map to obtain the other positioning result, and finally the final positioning result of the movable platform is determined through the two positioning results together, so that the movable platform can be positioned under the scene of sparse characteristics or lack of obvious characteristics, and the accuracy and stability of the high-precision map positioning result can be improved.
Referring to fig. 6, fig. 6 is a schematic flowchart illustrating steps of another high-precision map positioning method according to an embodiment of the present application.
Specifically, as shown in fig. 6, the high-precision map positioning method includes steps S401 to S407.
S401, acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises an offline complete height layer and an offline non-ground height layer.
The mobile platform acquires three-dimensional point cloud data of a traveling area through a high-precision laser radar, and processes the acquired three-dimensional point cloud data through a high-precision inertial navigation system and a point cloud registration algorithm to generate an off-line high-precision map.
In the moving process of the movable platform, an off-line high-precision map is obtained, three-dimensional point cloud data of objects around the movable platform are collected in real time through a laser radar, and an on-line point cloud map is built based on the three-dimensional point cloud data collected in real time.
The off-line high-precision map comprises an off-line complete height map layer and an off-line non-ground height map layer, wherein the height of each grid in the off-line complete height map layer is the average value height of three-dimensional point clouds in the grids, the off-line non-ground height map layer comprises a plurality of height intervals, the height intervals are obtained by dividing according to the heights of the three-dimensional point clouds, the height interval values of the height intervals can be identical or different, and the height interval values are the height difference values of two end points of the height intervals.
S402, acquiring a historical positioning result of the movable platform, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time.
Specifically, a historical positioning result of the movable platform is obtained, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time. It should be noted that the preset time may be set based on actual situations, which is not specifically limited in this application.
S403, determining a candidate positioning result set according to the historical positioning result.
Specifically, a historical position coordinate and a historical attitude angle are obtained from the historical positioning result; carrying out derivative processing on the historical position coordinates to determine gradient values and gradient directions of the historical position coordinates, and determining a candidate position set according to the gradient values and the gradient directions, namely, obtaining a preset number of candidate gradient values along the gradient directions based on the gradient values in a preset unit gradient mode, and determining position information corresponding to each candidate gradient value, so as to determine the candidate position set;
calculating the difference value of the historical attitude angle and the preset attitude error value, and calculating the sum of the historical attitude angle and the preset attitude error value; taking the difference value of the historical attitude angle and the preset attitude error value as one endpoint, taking the sum of the historical attitude angle and the preset attitude error value as the other endpoint to obtain a candidate attitude angle range, and obtaining a plurality of candidate attitude angles from the candidate attitude angle range by a preset unit attitude angle so as to form a candidate attitude set;
And determining a candidate positioning result set according to the candidate position set and the candidate gesture set, namely, each candidate position is selected from the candidate position set and combined with each candidate gesture in the candidate gesture set each time until each candidate position in the candidate position set is selected once, and collecting each candidate positioning result obtained by combination as the candidate positioning result set.
It should be noted that the preset unit gradients, the preset number, the preset attitude error values, and the preset unit attitude angles may be set based on actual situations, which are not specifically limited in this application.
In an embodiment, the determination method of the candidate positioning result set may be: and obtaining a historical position coordinate and a historical attitude angle from the historical positioning result, calculating the difference between the historical position coordinate and the historical attitude angle and the preset positioning error value respectively, calculating the sum of the historical position coordinate and the historical attitude angle and the preset positioning error value respectively, determining a candidate coordinate set based on the difference and the sum of the historical position coordinate and the preset positioning error value, determining a candidate attitude set based on the difference and the sum of the historical attitude angle and the preset positioning error value, and finally determining a candidate positioning result set based on the candidate coordinate set and the candidate attitude set. It should be noted that the preset positioning error value may be set based on practical situations, which is not specifically limited in this application.
And S404, carrying out rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein the online grid maps comprise online complete height layers and online non-ground height layers.
And the movable platform performs rasterization processing on the online point cloud map according to each candidate positioning result to obtain an online raster map corresponding to each candidate positioning result, namely marking each candidate positioning result in the candidate positioning result set in the online point cloud map, and performing rasterization processing on map areas around each marked candidate positioning result to obtain the raster map corresponding to each candidate positioning result.
The online grid map comprises an online complete height layer and an online non-ground height layer, the height of each grid in the online complete height layer is the average height of three-dimensional point clouds in the grids, the online non-ground height layer comprises a plurality of height intervals, the height intervals are obtained by dividing according to the heights of the three-dimensional point clouds, the height interval values of the height intervals can be identical or different, and the height interval values are the height difference values of two end points of the height intervals.
S405, positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer which correspond to each candidate positioning result, and obtaining a first positioning result.
After each candidate positioning result is determined by the movable platform, the movable platform is positioned according to a plurality of first height intervals in the offline high-precision map and a plurality of second height intervals in the online grid map corresponding to each candidate positioning result, and a first positioning result of the movable platform is obtained. The movable platform is positioned through a plurality of first height sections in the off-line high-precision map and a plurality of second height sections in each on-line grid map, so that an accurate positioning result can be obtained, and the accuracy and stability of the high-precision map positioning result can be improved.
S406, positioning the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result, and obtaining a second positioning result.
And the movable platform positions the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result, and a second positioning result of the movable platform is obtained. Specifically, according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result, determining the matching degree of each candidate positioning result; and determining a second positioning result from the candidate positioning result set according to the matching degree corresponding to each candidate positioning result.
S407, determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
After the first positioning result and the second positioning result of the movable platform are determined, determining a target positioning result of the movable platform according to the first positioning result and the second positioning result. By fusing the two positioning results, the accuracy and stability of the positioning results can be further improved.
In an embodiment, the mobile platform obtains a degree of matching of the first positioning result and a degree of matching of the second positioning result; determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result; and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
According to the high-precision map positioning method provided by the embodiment, the candidate positioning result set can be accurately determined through the historical positioning result and the positioning error value, the on-line point cloud map is subjected to rasterization processing based on each candidate positioning result in the accurate candidate positioning result set to obtain the grid map corresponding to each candidate positioning result, the movable platform is positioned through the off-line non-ground height layer and the on-line non-ground height layer in each grid map to obtain one positioning result, meanwhile, the movable platform is positioned through the off-line complete height layer and the on-line complete height layer in each grid map to obtain the other positioning result, and finally, the final positioning result of the movable platform is jointly determined through the two positioning results, so that the movable platform can be positioned under the condition that some features are sparse or lack of obvious features, and the accuracy and stability of the high-precision map positioning result can be improved.
Referring to fig. 7, fig. 7 is a schematic block diagram of a driving system according to an embodiment of the present application. In one embodiment, the driving system includes an unmanned system and a manned system. Further, the driving system 500 includes a processor 501, a memory 502 and a laser radar 503, where the processor 501, the memory 502 and the laser radar 503 are connected by a bus 504, such as an I2C (Inter-integrated Circuit) bus.
Specifically, the processor 501 may be a Micro-controller Unit (MCU), a central processing Unit (Central Processing Unit, CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
Specifically, the Memory 502 may be a Flash chip, a Read-Only Memory (ROM) disk, an optical disk, a U-disk, a removable hard disk, or the like.
Specifically, the processor 501 and the memory 502 are computing platforms of the driving system, and the lidar 303 may be an external device of the driving system or an internal component of the driving system, which is not limited in this application.
Wherein the processor 501 is arranged to run a computer program stored in the memory 502 and to implement the steps of the high precision map positioning method as described above when said computer program is executed.
It should be noted that, for convenience and brevity of description, specific working processes of the driving system described above may refer to corresponding processes in the foregoing embodiment of the high-precision map positioning method, and will not be described herein.
Referring to fig. 8, fig. 8 is a schematic block diagram of a movable platform according to an embodiment of the present application. The mobile platform 800 comprises a processor 601, a memory 602 and a lidar 603, the processor 801, the memory 602 and the lidar 603 being connected by a bus 604, such as an I2C (Inter-integrated Circuit) bus. The movable platform comprises a vehicle and an aircraft, the aircraft comprises an unmanned aerial vehicle and an unmanned aerial vehicle, the vehicle comprises a piloted vehicle, an unmanned vehicle and the like, the unmanned aerial vehicle comprises a rotor type unmanned aerial vehicle, such as a four-rotor unmanned aerial vehicle, a six-rotor unmanned aerial vehicle and an eight-rotor unmanned aerial vehicle, the unmanned aerial vehicle can also be a fixed-wing unmanned aerial vehicle, and the unmanned aerial vehicle can also be a combination of a rotary wing type unmanned aerial vehicle and a fixed-wing unmanned aerial vehicle, and is not limited herein.
Specifically, the processor 601 may be a Micro-controller Unit (MCU), a central processing Unit (Central Processing Unit, CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
Specifically, the Memory 602 may be a Flash chip, a Read-Only Memory (ROM) disk, an optical disk, a U-disk, a removable hard disk, or the like.
Specifically, the processor 601 and the memory 602 are computing platforms of the driving system, and the lidar 603 may be an external device of the driving system or an internal component of the driving system, which is not limited in this application.
Wherein the processor 601 is arranged to run a computer program stored in the memory 602 and to implement the steps of the high precision map positioning method as described above when said computer program is executed.
It should be noted that, for convenience and brevity of description, a specific working process of the above-described movable platform may refer to a corresponding process in the foregoing embodiment of the high-precision map positioning method, which is not described herein again.
An embodiment of the present application further provides a computer readable storage medium, where a computer program is stored, where the computer program includes program instructions, and the processor executes the program instructions to implement the steps of the high-precision map positioning method provided in the foregoing embodiment.
The computer readable storage medium may be an internal storage unit of the driving system or the mobile platform according to any one of the foregoing embodiments, for example, a hard disk or a memory of the driving system or the mobile platform. The computer readable storage medium may also be an external storage device of the driving system or the mobile platform, such as a plug-in hard disk, a Smart Media Card (SMC), a Secure Digital (SD) Card, a Flash memory Card (Flash Card) or the like, which are provided on the driving system or the mobile platform.
It is to be understood that the terminology used in the description of the present application is for the purpose of describing particular embodiments only and is not intended to be limiting of the application. As used in this specification and the appended claims, the singular forms "a," "an," and "the" are intended to include the plural forms as well, unless the context clearly indicates otherwise.
It should also be understood that the term "and/or" as used in this specification and the appended claims refers to any and all possible combinations of one or more of the associated listed items, and includes such combinations.
While the invention has been described with reference to certain preferred embodiments, it will be understood by those skilled in the art that various changes and substitutions of equivalents may be made and equivalents will be apparent to those skilled in the art without departing from the scope of the invention. Therefore, the protection scope of the present application shall be subject to the protection scope of the claims.

Claims (70)

1. A method of positioning a movable platform, comprising:
acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises a plurality of first altitude sections;
determining a candidate positioning result set, the candidate positioning result set comprising at least one candidate positioning result;
performing rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online grid map corresponding to each candidate positioning result, wherein the online grid map comprises a plurality of second height sections;
determining the matching degree of each candidate positioning result according to a plurality of first altitude intervals in the offline high-precision map and a plurality of second altitude intervals in the online grid map corresponding to each candidate positioning result;
And selecting one candidate positioning result from the candidate positioning result set as a first positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
2. The positioning method of a movable platform according to claim 1, wherein the off-line high-precision map includes an off-line non-ground level, the plurality of first height sections are located on the off-line non-ground level, the on-line grid map includes an on-line non-ground level, and the plurality of second height sections are located on the on-line non-ground level; the determining, according to the plurality of first altitude intervals in the offline high-precision map and the plurality of second altitude intervals in the online grid map corresponding to each candidate positioning result, the matching degree corresponding to each candidate positioning result includes:
determining the state comparison result between each second height interval in each online non-ground height layer and the corresponding first height interval in each offline non-ground height layer;
counting the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result;
And determining the matching degree corresponding to each candidate positioning result according to the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result, of each candidate positioning result.
3. The method for positioning a movable platform according to claim 2, wherein determining the status comparison result between each of the second height sections in each of the online non-ground-level layers and the corresponding first height section in the offline non-ground-level layer comprises:
acquiring first state identification information of each first height section in the off-line non-ground height layer and acquiring second state identification information of each second height section of each on-line non-ground height layer;
and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to the first state identification information and each second state identification information.
4. A method of positioning a movable platform according to any one of claims 1 to 3, wherein the online grid map further comprises an online full height map layer, the offline high-precision map further comprising an offline full height map layer; after selecting one candidate positioning result from the candidate positioning result set as the first positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result, the method further comprises:
Positioning the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result to obtain a second positioning result of the movable platform;
and fusing the first positioning result and the second positioning result to obtain a target positioning result of the movable platform.
5. The method for positioning a movable platform according to claim 4, wherein positioning the movable platform according to the online full height layer and the offline full height layer, which correspond to each of the candidate positioning results, to obtain a second positioning result of the movable platform, includes:
determining the matching degree of each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
and selecting one candidate positioning result from the candidate positioning result set as a second positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
6. The positioning method of a movable platform according to claim 5, wherein selecting one candidate positioning result from the candidate positioning result set as a second positioning result of the movable platform according to the respective matching degree of each candidate positioning result, comprises:
Checking the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the smallest matching degree as a second positioning result of the movable platform.
7. The method for positioning a movable platform according to claim 4, wherein the fusing the first positioning result and the second positioning result to obtain the target positioning result of the movable platform comprises:
obtaining the matching degree of the first positioning result and the matching degree of the second positioning result;
determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result;
and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
8. The positioning method of the movable platform according to claim 7, wherein determining the first weight coefficient of the first positioning result and the second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result comprises:
Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
determining a first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
and determining a second weight coefficient of the second positioning result according to the processed matching degree of the second positioning result and the total matching degree.
9. A method of positioning a movable platform according to any one of claims 1 to 3, wherein the determining a candidate set of positioning results comprises:
acquiring current position data and current posture data of a movable platform;
determining a candidate position set according to the current position data;
determining a candidate gesture set according to the current gesture data and a preset gesture error value;
and determining a candidate positioning result set according to the candidate position set and the candidate gesture set.
10. The method of claim 9, wherein said determining a candidate set of locations from said current location data comprises:
And determining the change trend of the current position data, and determining a candidate position set according to the change trend of the current position data.
11. The method of claim 9, wherein determining a candidate pose set from the current pose data and a preset pose error value comprises:
calculating a difference value between an attitude angle in the current attitude data and a preset attitude error value, and calculating a sum of the attitude angle in the current attitude data and the preset attitude error value;
and determining a candidate gesture set according to the difference value of the gesture angle in the current gesture data and the preset gesture error value and the sum of the gesture angle in the current gesture data and the preset gesture error value.
12. A method of positioning a movable platform according to any one of claims 1 to 3, wherein the determining a candidate set of positioning results comprises:
acquiring a historical positioning result of a movable platform, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time;
and determining a candidate positioning result set according to the historical positioning result.
13. A method of positioning a movable platform, comprising:
acquiring an offline high-precision map and establishing an online point cloud map, wherein the offline high-precision map comprises an offline complete height layer and an offline non-ground height layer;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises an online complete height layer and an online non-ground height layer;
determining the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result;
selecting one candidate positioning result from the candidate positioning result set as a first positioning result of the movable platform according to the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result; and
positioning the movable platform according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result respectively to obtain a second positioning result;
And determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
14. The method of claim 13, wherein the off-line non-ground height layer comprises a plurality of first height sections and the on-line non-ground height layer comprises a plurality of second height sections, the first height sections being the same as the corresponding second height sections; the determining the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result, comprises the following steps:
determining the state comparison result between each second height interval in each online non-ground height layer and the corresponding first height interval in each offline non-ground height layer;
counting the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result;
and taking each number as the matching degree between the online non-ground height layer and the offline non-ground height layer which are respectively corresponding to each candidate positioning result.
15. The method of claim 14, wherein determining a status comparison between each of the second height intervals in each of the online non-ground-level layers and the corresponding first height intervals in the offline non-ground-level layers comprises:
acquiring first state identification information of each first height section in the off-line non-ground height layer and acquiring second state identification information of each second height section of each on-line non-ground height layer;
and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to each second state identification information and the first state identification information.
16. The method for positioning a mobile platform according to claim 13, wherein positioning the mobile platform according to the online full height layer and the offline full height layer corresponding to each candidate positioning result respectively to obtain a second positioning result comprises:
determining the matching degree of each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
And determining a second positioning result from the candidate positioning result set according to the matching degree corresponding to each candidate positioning result.
17. The method for locating a mobile platform according to claim 16, wherein said determining a second location result from said set of candidate location results according to a respective degree of matching for each candidate location result comprises:
checking the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the smallest matching degree as a second positioning result.
18. The positioning method of a movable platform according to any one of claims 13 to 17, wherein the determining a target positioning result of the movable platform according to the first positioning result and the second positioning result comprises:
obtaining the matching degree of the first positioning result and the matching degree of the second positioning result;
determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result;
And determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
19. The positioning method of a movable platform according to claim 18, wherein determining the first weight coefficient of the first positioning result and the second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result comprises:
normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
determining a first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
and determining a second weight coefficient of the second positioning result according to the processed matching degree of the second positioning result and the total matching degree.
20. The method of positioning a movable platform according to any of claims 13 to 17, wherein the determining a candidate set of positioning results comprises:
Acquiring current position data and current posture data of a movable platform;
determining a candidate position set according to the current position data;
determining a candidate gesture set according to the current gesture data and a preset gesture error value;
and determining a candidate positioning result set according to the candidate position set and the candidate gesture set.
21. The method of claim 20, wherein said determining a candidate set of locations from said current location data comprises:
and determining the change trend of the current position data, and determining a candidate position set according to the change trend of the current position data.
22. The method of claim 20, wherein determining a candidate pose set from the current pose data and a preset pose error value comprises:
calculating a difference value between an attitude angle in the current attitude data and a preset attitude error value, and calculating a sum of the attitude angle in the current attitude data and the preset attitude error value;
and determining a candidate gesture set according to the difference value of the gesture angle in the current gesture data and the preset gesture error value and the sum of the gesture angle in the current gesture data and the preset gesture error value.
23. The method of positioning a movable platform according to any of claims 13 to 17, wherein the determining a candidate set of positioning results comprises:
acquiring a historical positioning result of a movable platform, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time;
and determining a candidate positioning result set according to the historical positioning result.
24. A driving system, comprising a lidar, a memory, and a processor;
the memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises a plurality of first altitude sections;
determining a candidate positioning result set, the candidate positioning result set comprising at least one candidate positioning result;
performing rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online grid map corresponding to each candidate positioning result, wherein the online grid map comprises a plurality of second height sections;
Determining the matching degree of each candidate positioning result according to a plurality of second height intervals in the online grid map and a plurality of first height intervals in the offline high-precision map, which correspond to each candidate positioning result;
and selecting one candidate positioning result from the candidate positioning result set as a first positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
25. The driving system of claim 24, wherein the off-line high precision map comprises an off-line non-ground level, the plurality of first height intervals being located at the off-line non-ground level, the on-line grid map comprising an on-line non-ground level, the plurality of second height intervals being located at the on-line non-ground level; the processor is used for realizing that when the matching degree corresponding to each candidate positioning result is determined according to the second height intervals in the online grid map and the first height intervals in the offline high-precision map corresponding to each candidate positioning result, the processor is used for realizing:
Determining the state comparison result between each second height interval in each online non-ground height layer and the corresponding first height interval in each offline non-ground height layer;
counting the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result;
and determining the matching degree corresponding to each candidate positioning result according to the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result, of each candidate positioning result.
26. The driving system of claim 25, wherein the processor is configured to determine each of the second height intervals in each of the online non-ground-level layers, and when comparing the status between the second height interval and the corresponding first height interval in the offline non-ground-level layer, perform:
acquiring first state identification information of each first height section in the off-line non-ground height layer and acquiring second state identification information of each second height section of each on-line non-ground height layer;
and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to the first state identification information and each second state identification information.
27. The driving system of any one of claims 24-26, wherein the online grid map further comprises an online full height map layer, the offline high-precision map further comprising an offline full height map layer; the processor is further configured to, after selecting one candidate positioning result from the candidate positioning result set as a first positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result, implement:
positioning the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result to obtain a second positioning result of the movable platform;
and fusing the first positioning result and the second positioning result to obtain a target positioning result of the movable platform.
28. The driving system of claim 27, wherein the processor is configured to implement positioning the movable platform according to the online full height layer and the offline full height layer corresponding to each of the candidate positioning results, and when obtaining a second positioning result of the movable platform, to implement:
Determining the matching degree of each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
and selecting one candidate positioning result from the candidate positioning result set as a second positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
29. The driving system of claim 28, wherein the processor is configured to, when selecting one of the candidate positioning results from the candidate positioning result set as the second positioning result of the movable platform according to the respective matching degree of each of the candidate positioning results, implement:
checking the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the smallest matching degree as a second positioning result of the movable platform.
30. The driving system of claim 27, wherein the processor is configured to, when performing the fusing of the first positioning result and the second positioning result to obtain the target positioning result of the movable platform, perform:
Obtaining the matching degree of the first positioning result and the matching degree of the second positioning result;
determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result;
and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
31. The driving system of claim 30, wherein the processor is configured to, when determining the first weight coefficient of the first positioning result and the second weight coefficient of the second positioning result according to the degree of matching of the first positioning result and the degree of matching of the second positioning result, implement:
normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
determining a first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
And determining a second weight coefficient of the second positioning result according to the processed matching degree of the second positioning result and the total matching degree.
32. A driving system according to any one of claims 24 to 26, wherein the processor is configured to determine a candidate positioning result set for:
acquiring current position data and current posture data of a movable platform;
determining a candidate position set according to the current position data;
determining a candidate gesture set according to the current gesture data and a preset gesture error value;
and determining a candidate positioning result set according to the candidate position set and the candidate gesture set.
33. The driving system of claim 32, wherein the processor is configured to determine a set of candidate locations from the current location data for implementation:
and determining the change trend of the current position data, and determining a candidate position set according to the change trend of the current position data.
34. The driving system of claim 32, wherein the determining a candidate pose set from the current pose data and a preset pose error value is configured to:
calculating a difference value between an attitude angle in the current attitude data and a preset attitude error value, and calculating a sum of the attitude angle in the current attitude data and the preset attitude error value;
And determining a candidate gesture set according to the difference value of the gesture angle in the current gesture data and the preset gesture error value and the sum of the gesture angle in the current gesture data and the preset gesture error value.
35. A driving system according to any one of claims 24 to 26, wherein the processor is configured to determine a candidate positioning result set for:
acquiring a historical positioning result of a movable platform, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time;
and determining a candidate positioning result set according to the historical positioning result.
36. A driving system, comprising a lidar, a memory, and a processor;
the memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises an off-line complete height layer and an off-line non-ground height layer;
Determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises an online complete height layer and an online non-ground height layer;
determining the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result;
selecting one candidate positioning result from the candidate positioning result set as a first positioning result of a movable platform according to the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result; and
positioning the movable platform according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result respectively to obtain a second positioning result;
and determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
37. The driving system of claim 36, wherein the off-line non-ground height layer comprises a plurality of first height intervals and the on-line non-ground height layer comprises a plurality of second height intervals, the first height intervals being the same as the corresponding second height intervals; the processor is used for determining the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result, and is used for realizing the following steps:
Determining the state comparison result between each second height interval in each online non-ground height layer and the corresponding first height interval in each offline non-ground height layer;
counting the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result;
and taking each number as the matching degree between the online non-ground height layer and the offline non-ground height layer which are respectively corresponding to each candidate positioning result.
38. The driving system of claim 37, wherein the processor is configured to determine each of the second height intervals in each of the online non-ground-level layers and a status comparison between the second height intervals corresponding to the first height intervals in the offline non-ground-level layers for implementation:
acquiring first state identification information of each first height section in the off-line non-ground height layer and acquiring second state identification information of each second height section of each on-line non-ground height layer;
and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to each second state identification information and the first state identification information.
39. The driving system of claim 36, wherein the processor is configured to implement positioning the movable platform according to the online full height layer and the offline full height layer corresponding to each candidate positioning result, to obtain a second positioning result, where the second positioning result is used to implement:
determining the matching degree of each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
and determining a second positioning result from the candidate positioning result set according to the matching degree corresponding to each candidate positioning result.
40. The driving system of claim 39, wherein the processor is configured to determine a second positioning result from the set of candidate positioning results based on a respective degree of matching for each candidate positioning result, for achieving:
checking the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the smallest matching degree as a second positioning result.
41. The driving system of any one of claims 36-40, wherein the processor implements determining a target positioning result for the movable platform based on the first positioning result and the second positioning result for implementing:
obtaining the matching degree of the first positioning result and the matching degree of the second positioning result;
determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result;
and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
42. The driving system as recited in claim 41 wherein said processor implements determining a first weight coefficient for said first positioning result and a second weight coefficient for said second positioning result based on a degree of matching of said first positioning result and a degree of matching of said second positioning result for implementing:
normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
Determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
determining a first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
and determining a second weight coefficient of the second positioning result according to the processed matching degree of the second positioning result and the total matching degree.
43. The driving system of any one of claims 36-40, wherein the processor is configured to determine a candidate positioning result set for implementation:
acquiring current position data and current posture data of a movable platform;
determining a candidate position set according to the current position data;
determining a candidate gesture set according to the current gesture data and a preset gesture error value;
and determining a candidate positioning result set according to the candidate position set and the candidate gesture set.
44. The driving system as defined in claim 43 wherein said processor is configured to determine a set of candidate locations based on said current location data for use in performing:
and determining the change trend of the current position data, and determining a candidate position set according to the change trend of the current position data.
45. The driving system of claim 43, wherein the processor is configured to determine a candidate pose set based on the current pose data and a preset pose error value for:
calculating a difference value between an attitude angle in the current attitude data and a preset attitude error value, and calculating a sum of the attitude angle in the current attitude data and the preset attitude error value;
and determining a candidate gesture set according to the difference value of the gesture angle in the current gesture data and the preset gesture error value and the sum of the gesture angle in the current gesture data and the preset gesture error value.
46. The driving system of any one of claims 36-40, wherein the processor is configured to determine a candidate positioning result set for implementation:
acquiring a historical positioning result of a movable platform, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time;
and determining a candidate positioning result set according to the historical positioning result.
47. A mobile platform comprising a lidar, a memory, and a processor;
The memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises a plurality of first altitude sections;
determining a candidate positioning result set, the candidate positioning result set comprising at least one candidate positioning result;
performing rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online grid map corresponding to each candidate positioning result, wherein the online grid map comprises a plurality of second height sections;
determining the matching degree of each candidate positioning result according to a plurality of second height intervals in the online grid map and a plurality of first height intervals in the offline high-precision map, which correspond to each candidate positioning result;
and selecting one candidate positioning result from the candidate positioning result set as a first positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
48. The mobile platform of claim 47, wherein the off-line high precision map comprises an off-line non-ground level, the plurality of first height intervals are located at the off-line non-ground level, the on-line grid map comprises an on-line non-ground level, and the plurality of second height intervals are located at the on-line non-ground level; the processor is used for realizing that when the matching degree corresponding to each candidate positioning result is determined according to the second height intervals in the online grid map corresponding to each candidate positioning result and the first height intervals in the offline high-precision map, the processor is used for realizing:
determining the state comparison result between each second height interval in each online non-ground height layer and the corresponding first height interval in each offline non-ground height layer;
counting the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result;
and determining the matching degree corresponding to each candidate positioning result according to the number of the second height intervals, wherein the state comparison result in each online non-ground height layer is a preset state comparison result, of each candidate positioning result.
49. The mobile platform of claim 48, wherein the processor is configured to, when determining each of the second height intervals in each of the online non-floor height layers, compare the status of the second height intervals with the corresponding first height intervals in the offline non-floor height layers, perform:
acquiring first state identification information of each first height section in the off-line non-ground height layer and acquiring second state identification information of each second height section of each on-line non-ground height layer;
and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to the first state identification information and each second state identification information.
50. The mobile platform of any one of claims 47 to 49, wherein the online grid map further comprises an online full height map layer, the offline high-precision map further comprising an offline full height map layer; the processor is further configured to, after selecting one candidate positioning result from the candidate positioning result set as the first positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result, implement:
Positioning the movable platform according to the online complete height layer and the offline complete height layer which are respectively corresponding to each candidate positioning result to obtain a second positioning result of the movable platform;
and fusing the first positioning result and the second positioning result to obtain a target positioning result of the movable platform.
51. The mobile platform of claim 50, wherein the processor is configured to implement positioning the mobile platform according to the online full height layer and the offline full height layer corresponding to each of the candidate positioning results, and when obtaining a second positioning result of the mobile platform, the processor is configured to implement:
determining the matching degree of each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
and selecting one candidate positioning result from the candidate positioning result set as a second positioning result of the movable platform according to the matching degree corresponding to each candidate positioning result.
52. The mobile platform as recited in claim 51, wherein the processor is configured to, when selecting one of the candidate positioning results from the set of candidate positioning results as the second positioning result for the mobile platform based on a respective degree of matching for each of the candidate positioning results,:
Checking the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the smallest matching degree as a second positioning result of the movable platform.
53. The mobile platform of claim 50, wherein the processor is configured to, when performing fusion of the first positioning result and the second positioning result to obtain a target positioning result of the mobile platform, perform:
obtaining the matching degree of the first positioning result and the matching degree of the second positioning result;
determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result;
and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
54. The mobile platform of claim 53, wherein the processor is configured to, when determining the first weight coefficient of the first positioning result and the second weight coefficient of the second positioning result according to the degree of matching of the first positioning result and the degree of matching of the second positioning result,:
Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
determining a first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
and determining a second weight coefficient of the second positioning result according to the processed matching degree of the second positioning result and the total matching degree.
55. The mobile platform of any one of claims 47 to 49, wherein the processor is configured to determine a candidate positioning result set for implementation:
acquiring current position data and current posture data of a movable platform;
determining a candidate position set according to the current position data;
determining a candidate gesture set according to the current gesture data and a preset gesture error value;
and determining a candidate positioning result set according to the candidate position set and the candidate gesture set.
56. The mobile platform of claim 55, wherein the processor is configured to determine a set of candidate locations based on the current location data for implementation:
And determining the change trend of the current position data, and determining a candidate position set according to the change trend of the current position data.
57. The mobile platform of claim 55, wherein the determining a candidate pose set from the current pose data and a preset pose error value is configured to:
calculating a difference value between an attitude angle in the current attitude data and a preset attitude error value, and calculating a sum of the attitude angle in the current attitude data and the preset attitude error value;
and determining a candidate gesture set according to the difference value of the gesture angle in the current gesture data and the preset gesture error value and the sum of the gesture angle in the current gesture data and the preset gesture error value.
58. The mobile platform of any one of claims 47 to 49, wherein the processor is configured to determine a candidate positioning result set for implementation:
acquiring a historical positioning result of a movable platform, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time;
and determining a candidate positioning result set according to the historical positioning result.
59. A mobile platform comprising a lidar, a memory, and a processor;
the memory is used for storing a computer program;
the processor is configured to execute the computer program and implement the following steps when the computer program is executed:
acquiring an off-line high-precision map, and establishing an on-line point cloud map through three-dimensional point cloud data acquired by the laser radar, wherein the off-line high-precision map comprises an off-line complete height layer and an off-line non-ground height layer;
determining a candidate positioning result set, and carrying out rasterization on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain online grid maps corresponding to each candidate positioning result, wherein each online grid map comprises an online complete height layer and an online non-ground height layer;
determining the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result;
selecting one candidate positioning result from the candidate positioning result set as a first positioning result of the movable platform according to the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result; and
Positioning the movable platform according to the online complete height layer and the offline complete height layer which correspond to each candidate positioning result respectively to obtain a second positioning result;
and determining a target positioning result of the movable platform according to the first positioning result and the second positioning result.
60. The mobile platform of claim 59, wherein the offline non-floor height map comprises a plurality of first height sections, and the online non-floor height map comprises a plurality of second height sections, the first height sections being the same as the corresponding second height sections; the processor is used for determining the matching degree between the online non-ground height layer and the offline non-ground height layer, which are respectively corresponding to each candidate positioning result, and is used for realizing the following steps:
determining the state comparison result between each second height interval in each online non-ground height layer and the corresponding first height interval in each offline non-ground height layer;
counting the number of the second height sections, wherein the state comparison result in each online non-ground height layer is a preset state comparison result;
And taking each number as the matching degree between the online non-ground height layer and the offline non-ground height layer which are respectively corresponding to each candidate positioning result.
61. The mobile platform of claim 60, wherein the processor is configured to determine each of the second height intervals in each of the online non-floor height layers, and compare the status of each of the second height intervals with the status of the corresponding first height intervals in the offline non-floor height layers, to:
acquiring first state identification information of each first height section in the off-line non-ground height layer and acquiring second state identification information of each second height section of each on-line non-ground height layer;
and determining a state comparison result between each second height section in each online non-ground height layer and the corresponding first height section in the offline non-ground height layer according to each second state identification information and the first state identification information.
62. The mobile platform of claim 59, wherein the processor is configured to implement positioning the mobile platform according to the online full-height layer and the offline full-height layer corresponding to each candidate positioning result, to obtain a second positioning result, where the second positioning result is configured to implement:
Determining the matching degree of each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
and determining a second positioning result from the candidate positioning result set according to the matching degree corresponding to each candidate positioning result.
63. The mobile platform of claim 62, wherein the processor is configured to determine a second positioning result from the set of candidate positioning results based on a respective degree of matching for each candidate positioning result, for implementation:
checking the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
and acquiring the matching degree corresponding to each candidate positioning result passing the verification, and taking the candidate positioning result passing the verification corresponding to the smallest matching degree as a second positioning result.
64. The mobile platform of any one of claims 59-63, wherein the processor implements determining a target positioning result of the mobile platform from the first positioning result and the second positioning result for implementing:
Obtaining the matching degree of the first positioning result and the matching degree of the second positioning result;
determining a first weight coefficient of the first positioning result and a second weight coefficient of the second positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result;
and determining a target positioning result of the movable platform according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
65. The mobile platform of claim 64, wherein the processor is configured to determine a first weight coefficient for the first positioning result and a second weight coefficient for the second positioning result based on a degree of matching of the first positioning result and a degree of matching of the second positioning result, for:
normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
determining the total matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
determining a first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
And determining a second weight coefficient of the second positioning result according to the processed matching degree of the second positioning result and the total matching degree.
66. The mobile platform of any one of claims 59 to 63, wherein the processor is configured to determine a candidate positioning result set for implementation:
acquiring current position data and current posture data of a movable platform;
determining a candidate position set according to the current position data;
determining a candidate gesture set according to the current gesture data and a preset gesture error value;
and determining a candidate positioning result set according to the candidate position set and the candidate gesture set.
67. The mobile platform of claim 66, wherein the processor is configured to determine a set of candidate locations from the current location data, for implementation:
and determining the change trend of the current position data, and determining a candidate position set according to the change trend of the current position data.
68. The mobile platform of claim 66, wherein the processor is configured to determine a candidate pose set based on the current pose data and a preset pose error value for implementation:
Calculating a difference value between an attitude angle in the current attitude data and a preset attitude error value, and calculating a sum of the attitude angle in the current attitude data and the preset attitude error value;
and determining a candidate gesture set according to the difference value of the gesture angle in the current gesture data and the preset gesture error value and the sum of the gesture angle in the current gesture data and the preset gesture error value.
69. The mobile platform of any one of claims 59 to 63, wherein the processor is configured to determine a candidate positioning result set for implementation:
acquiring a historical positioning result of a movable platform, wherein the historical positioning result is a positioning result determined by the movable platform at the last moment, and the last moment is spaced from the current moment by a preset time;
and determining a candidate positioning result set according to the historical positioning result.
70. A computer readable storage medium, characterized in that the computer readable storage medium stores a computer program which, when executed by a processor, causes the processor to implement the positioning method of the movable platform according to any one of claims 1 to 23.
CN201980032943.3A 2019-09-19 2019-09-19 High-precision map positioning method, system, platform and computer readable storage medium Active CN112154355B (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2019/106792 WO2021051361A1 (en) 2019-09-19 2019-09-19 High-precision map positioning method and system, platform and computer-readable storage medium

Publications (2)

Publication Number Publication Date
CN112154355A CN112154355A (en) 2020-12-29
CN112154355B true CN112154355B (en) 2024-03-01

Family

ID=73891528

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201980032943.3A Active CN112154355B (en) 2019-09-19 2019-09-19 High-precision map positioning method, system, platform and computer readable storage medium

Country Status (2)

Country Link
CN (1) CN112154355B (en)
WO (1) WO2021051361A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113791423A (en) * 2021-09-24 2021-12-14 山东新一代信息产业技术研究院有限公司 Robot repositioning method based on multi-sensor fusion
CN115877429B (en) * 2023-02-07 2023-07-07 安徽蔚来智驾科技有限公司 Positioning method and device for automatic driving vehicle, storage medium and vehicle

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105928505A (en) * 2016-04-19 2016-09-07 深圳市神州云海智能科技有限公司 Determination method and apparatus for position and orientation of mobile robot
CN106052697A (en) * 2016-05-24 2016-10-26 百度在线网络技术(北京)有限公司 Driverless vehicle, driverless vehicle positioning method, driverless vehicle positioning device and driverless vehicle positioning system
CN106441319A (en) * 2016-09-23 2017-02-22 中国科学院合肥物质科学研究院 System and method for generating lane-level navigation map of unmanned vehicle
CN106908775A (en) * 2017-03-08 2017-06-30 同济大学 A kind of unmanned vehicle real-time location method based on laser reflection intensity
CN108225341A (en) * 2016-12-14 2018-06-29 乐视汽车(北京)有限公司 Vehicle positioning method
CN108897334A (en) * 2018-07-19 2018-11-27 上海交通大学 A kind of imitative insect flapping wing aircraft attitude control method based on fuzzy neural network
CN109064506A (en) * 2018-07-04 2018-12-21 百度在线网络技术(北京)有限公司 Accurately drawing generating method, device and storage medium
CN109725329A (en) * 2019-02-20 2019-05-07 苏州风图智能科技有限公司 A kind of unmanned vehicle localization method and device
CN109781119A (en) * 2017-11-15 2019-05-21 百度在线网络技术(北京)有限公司 A kind of laser point cloud localization method and system

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017175163A1 (en) * 2016-04-07 2017-10-12 Kaushish Ketan A method and system for optimizing an itinerary and navigating through the itinerary
CN108732582B (en) * 2017-04-20 2020-07-10 百度在线网络技术(北京)有限公司 Vehicle positioning method and device
US10684372B2 (en) * 2017-10-03 2020-06-16 Uatc, Llc Systems, devices, and methods for autonomous vehicle localization
CN109084732B (en) * 2018-06-29 2021-01-12 北京旷视科技有限公司 Positioning and navigation method, device and processing equipment
CN109353179B (en) * 2018-10-19 2022-04-01 中国第一汽车股份有限公司 Active suspension system based on high-precision map cloud information and control method
CN110246182B (en) * 2019-05-29 2021-07-30 达闼机器人有限公司 Vision-based global map positioning method and device, storage medium and equipment

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105928505A (en) * 2016-04-19 2016-09-07 深圳市神州云海智能科技有限公司 Determination method and apparatus for position and orientation of mobile robot
CN106052697A (en) * 2016-05-24 2016-10-26 百度在线网络技术(北京)有限公司 Driverless vehicle, driverless vehicle positioning method, driverless vehicle positioning device and driverless vehicle positioning system
CN106441319A (en) * 2016-09-23 2017-02-22 中国科学院合肥物质科学研究院 System and method for generating lane-level navigation map of unmanned vehicle
CN108225341A (en) * 2016-12-14 2018-06-29 乐视汽车(北京)有限公司 Vehicle positioning method
CN106908775A (en) * 2017-03-08 2017-06-30 同济大学 A kind of unmanned vehicle real-time location method based on laser reflection intensity
CN109781119A (en) * 2017-11-15 2019-05-21 百度在线网络技术(北京)有限公司 A kind of laser point cloud localization method and system
CN109064506A (en) * 2018-07-04 2018-12-21 百度在线网络技术(北京)有限公司 Accurately drawing generating method, device and storage medium
CN108897334A (en) * 2018-07-19 2018-11-27 上海交通大学 A kind of imitative insect flapping wing aircraft attitude control method based on fuzzy neural network
CN109725329A (en) * 2019-02-20 2019-05-07 苏州风图智能科技有限公司 A kind of unmanned vehicle localization method and device

Also Published As

Publication number Publication date
CN112154355A (en) 2020-12-29
WO2021051361A1 (en) 2021-03-25

Similar Documents

Publication Publication Date Title
CN110146909B (en) Positioning data processing method
CN109143207B (en) Laser radar internal reference precision verification method, device, equipment and medium
CN110609290B (en) Laser radar matching positioning method and device
CN109270545B (en) Positioning true value verification method, device, equipment and storage medium
CN111290385A (en) Robot path planning method, robot, electronic device and storage medium
CN111812658A (en) Position determination method, device, system and computer readable storage medium
CN113147738A (en) Automatic parking positioning method and device
CN112154429B (en) High-precision map positioning method, system, platform and computer readable storage medium
CN112154355B (en) High-precision map positioning method, system, platform and computer readable storage medium
CN112154303B (en) High-precision map positioning method, system, platform and computer readable storage medium
CN111812669B (en) Winding machine inspection device, positioning method thereof and storage medium
CN114485698B (en) Intersection guide line generation method and system
CN114829971A (en) Laser radar calibration method and device and storage medium
CN111208526B (en) Multi-unmanned aerial vehicle cooperative positioning method based on laser radar and positioning vector matching
CN112036274A (en) Driving region detection method and device, electronic equipment and storage medium
WO2021016749A1 (en) Multi-data fusion-based positioning method, movable platform and storage medium
CN109870716A (en) Localization method and positioning device and computer readable storage medium
CN114264301A (en) Vehicle-mounted multi-sensor fusion positioning method and device, chip and terminal
Wu et al. A Non-rigid hierarchical discrete grid structure and its application to UAVs conflict detection and path planning
CN113448340B (en) Unmanned aerial vehicle path planning method and device, unmanned aerial vehicle and storage medium
CN112629547A (en) Method and apparatus for creating positioning map
CN111812668B (en) Winding inspection device, positioning method thereof and storage medium
CN112747752A (en) Vehicle positioning method, device, equipment and storage medium based on laser odometer
US20210405197A1 (en) GLOBAL LOCALIZATION APPARATUS AND METHOD IN DYNAMIC ENVIRONMENTS USING 3D LiDAR SCANNER
KR102618951B1 (en) Method for visual mapping, and computer program recorded on record-medium for executing method therefor

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