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

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

Info

Publication number
WO2021051361A1
WO2021051361A1 PCT/CN2019/106792 CN2019106792W WO2021051361A1 WO 2021051361 A1 WO2021051361 A1 WO 2021051361A1 CN 2019106792 W CN2019106792 W CN 2019106792W WO 2021051361 A1 WO2021051361 A1 WO 2021051361A1
Authority
WO
WIPO (PCT)
Prior art keywords
positioning result
candidate
height
online
matching degree
Prior art date
Application number
PCT/CN2019/106792
Other languages
French (fr)
Chinese (zh)
Inventor
钟阳
周游
孙路
江灿森
Original Assignee
深圳市大疆创新科技有限公司
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 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to PCT/CN2019/106792 priority Critical patent/WO2021051361A1/en
Priority to CN201980032943.3A priority patent/CN112154355B/en
Publication of WO2021051361A1 publication Critical patent/WO2021051361A1/en

Links

Images

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

Definitions

  • This application relates to the technical field of high-precision maps, and in particular to a high-precision map positioning method, system, platform, and computer-readable storage medium.
  • high-precision maps have begun to be used in more and more fields.
  • high-precision map positioning is to obtain the surrounding environment and some characteristic information of the surrounding environment through the sensors mounted on the mobile platform, and then match these characteristic information with the characteristic information in the high-precision map, so as to obtain the mobile platform at high altitude. Positioning in the accuracy map.
  • this application provides a high-precision map positioning method, system, platform, and computer-readable storage medium, aiming to improve the accuracy and stability of the high-precision map positioning result.
  • this application provides a high-precision map positioning method, including:
  • the online grid map includes a plurality of second height intervals
  • the movable platform is positioned to obtain the The first positioning result of the mobile platform.
  • this application also provides a high-precision map positioning method, including:
  • Online raster map includes online complete height layer and online non-ground height layer;
  • the target positioning result of the movable platform is determined.
  • the present application also provides a driving system, the driving system includes a lidar, a memory, and a processor; the memory is used to store a computer program;
  • the processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
  • the online grid map includes a plurality of second height intervals
  • the movable platform is positioned to obtain the The first positioning result of the mobile platform.
  • the present application also provides a driving system, the driving system includes a lidar, a memory, and a processor; the memory is used to store a computer program;
  • the processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
  • Online raster map includes online complete height layer and online non-ground height layer;
  • the target positioning result of the movable platform is determined.
  • the present application also provides a movable platform, the movable platform includes a lidar, a memory, and a processor; the memory is used to store a computer program;
  • the processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
  • the online grid map includes a plurality of second height intervals
  • the movable platform is positioned to obtain the The first positioning result of the mobile platform.
  • the present application also provides a movable platform, the movable platform includes a lidar, a memory, and a processor; the memory is used to store a computer program;
  • the processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
  • Online raster map includes online complete height layer and online non-ground height layer;
  • the target positioning result of the movable platform is determined.
  • the present application also provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor achieves the above-mentioned high precision Map positioning method.
  • the embodiments of the application provide a high-precision map positioning method, system, platform, and computer-readable storage medium.
  • the online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set to obtain each
  • the mobile platform can also be positioned in the scene with obvious characteristics, which can improve the accuracy and stability of the high-precision map positioning result.
  • FIG. 1 is a schematic flowchart of the steps of a high-precision map positioning method provided by an embodiment of the present application
  • FIG. 2 is a schematic flowchart of sub-steps of the high-precision map positioning method in FIG. 1;
  • FIG. 3 is a schematic flowchart of steps of another high-precision map positioning method provided by an embodiment of the present application.
  • FIG. 4 is a schematic flowchart of sub-steps of the high-precision map positioning method in FIG. 3;
  • FIG. 5 is a schematic flowchart of steps of another high-precision map positioning method provided by an embodiment of the present application.
  • FIG. 6 is a schematic flowchart of the steps of another high-precision map positioning method provided by an embodiment of the present application.
  • FIG. 7 is a schematic block diagram of the structure of a driving system provided by an embodiment of the present application.
  • FIG. 8 is a schematic block diagram of the structure of a movable platform provided by an embodiment of the present application.
  • FIG. 1 is a schematic flowchart of 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.
  • movable platforms include vehicles and aircraft.
  • Aircraft include unmanned aerial vehicles and manned aerial vehicles.
  • Vehicles include manned and unmanned vehicles.
  • Unmanned aerial vehicles include rotary-wing unmanned aerial vehicles, such as four-rotor unmanned aerial vehicles and six-rotor unmanned aerial vehicles.
  • the high-precision map positioning method includes steps S101 to S103.
  • the mobile platform uses high-precision lidar to collect three-dimensional point cloud data from the traveled area, and uses high-precision inertial navigation system and point cloud registration algorithm to process the collected three-dimensional point cloud data to generate offline high Accuracy map.
  • use high-precision lidar to collect three-dimensional point cloud data from the traveled area use the Inertial Measurement Unit (IMU) to collect the attitude data of the movable platform, and use the Global Positioning System (GPS) Collect the position data of the movable platform, then correct the collected 3D point cloud data based on the posture data and the position data, and generate an offline high-precision map based on the corrected 3D point cloud data.
  • IMU Inertial Measurement Unit
  • GPS Global Positioning System
  • the mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data.
  • the lidar can determine the 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 light on the object, and the emission direction of the laser at the laser emission point.
  • the three-dimensional point cloud data of objects around the movable platform includes 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 offline high-precision map includes a plurality of first height intervals, the height of each grid in the offline high-precision map is located in the corresponding first height interval, and the first height interval is performed according to the height of the three-dimensional point cloud.
  • the height interval value of each first height interval may be the same or different, and the height interval value is the height difference between the two end points of the height interval.
  • the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application. For example, if the height is 26 meters, the divided first height intervals are [0, 1), [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 7 first height intervals.
  • S102 Determine a candidate positioning result set, and perform rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online raster map corresponding to each candidate positioning result.
  • the online grid map includes a plurality of second height intervals.
  • the mobile platform determines the candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, in the online point cloud map Mark each candidate positioning result in the candidate positioning result set, and perform rasterization processing on the map area around each marked candidate positioning result, so that a grid map corresponding to each candidate positioning result can be obtained.
  • the online grid map includes a plurality of second height intervals, the height of each grid in the online grid map is located in the corresponding second height interval, and the second height interval is divided according to the height of the three-dimensional point cloud Obtained, the height interval value of each second height interval may be the same or different, and the height interval value is the height difference value between the two end points of the height interval.
  • the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application. For example, if the height is 26 meters, the divided second height intervals are [0, 1), [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 7 second height intervals.
  • first height interval and the second height interval may be the same or different.
  • the first height interval and the second height interval have a corresponding relationship, and there is a corresponding relationship between the first height interval and the second height interval.
  • the two ends of the interval are the same, which is not specifically limited in this application.
  • the method for determining the candidate positioning result set is specifically: obtaining the current position data and current attitude data of the movable platform; determining the candidate position set according to the current position data; determining the candidate position set according to the current attitude data and the preset attitude error value Pose set: Determine the candidate positioning result set according to the candidate position set and the candidate pose set.
  • the current position data of the movable platform is the position data output by the positioning system of the movable platform at the current moment
  • the current posture data of the movable platform is the posture data output by the inertial measurement unit of the movable platform at the current moment.
  • the position data includes the geographic coordinates of the movable platform
  • the attitude data includes the pitch angle, roll angle, and yaw angle of the movable platform.
  • the method of determining the candidate location set according to the current location data is specifically as follows: the movable platform determines the change trend of the current location data, and determines the candidate location set according to the change trend of the current location data.
  • the change trend can be characterized by the gradient value and gradient direction of the current position data, that is, a preset unit gradient is used to obtain a preset number of candidate gradient values along the gradient direction based on the gradient value, and determine The position information corresponding to each candidate gradient value is used to determine the candidate position set.
  • the preset unit gradient and the preset number can be set based on actual conditions, which is not specifically limited in this application.
  • the method for determining the candidate pose set may be: calculating the difference between the pose angle in the current pose data and the preset pose error value, and calculating the sum of the pose angle in the current pose data and the preset pose error value , And then based on the difference 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, determine the candidate attitude set, that is, the attitude angle and the preset attitude error The difference of is one end point, and the sum of the attitude angle and the preset attitude error value is the other end point to obtain the candidate attitude angle range, and obtain multiple candidate attitude angles from the candidate attitude angle range in the preset unit attitude angle , So as to form a set of candidate poses.
  • the above-mentioned preset attitude error value and unit attitude angle can be set based on actual conditions, which is not specifically limited in this application.
  • the current pose data and preset pose error values can quickly and accurately determine the candidate pose set.
  • the method for determining the candidate pose set may also be: the movable platform determines the position coordinates of the movable platform in the offline high-precision map according to the current position data, that is, obtains the position coordinates of the movable platform from the current position data. Geographic location coordinates, and mark the geographic location coordinates in the offline high-precision map, and then obtain the location coordinates of objects around the geographic location coordinates in the offline high-precision map, and based on the location coordinates of surrounding objects in the offline high-precision map, Determine the position coordinates of the movable platform in the offline high-precision map; determine the candidate position set according to the position coordinates and the preset position error value.
  • the candidate position set can be quickly and accurately determined through the current position data and the preset position error value.
  • the method for determining the candidate positioning result set is specifically as follows: the movable platform selects one candidate position from the candidate position set each time to combine with each candidate pose in the candidate pose set, Until the candidate positions in the candidate position set are selected once, each candidate positioning result obtained by the collection and combination is used as the candidate positioning result set.
  • the method for determining the candidate positioning result set may also be: obtaining the historical positioning result of the movable platform, and determining the candidate positioning result set according to the historical positioning result.
  • the historical positioning result is the positioning result determined by the movable platform at the last moment, and the last moment and the current moment are separated by a preset time. It should be noted that the aforementioned preset time can be set based on actual conditions, which is not specifically limited in this application.
  • each candidate positioning result set determines the candidate positioning result set, that is, each candidate position is selected from the candidate position set and combined with each candidate pose in the candidate pose set until the candidate positions in the candidate position set are selected once At this time, each candidate positioning result obtained by the collection and combination is used as a candidate positioning result set.
  • preset unit gradient, preset number, preset attitude error value, and preset unit attitude angle can be set based on actual conditions, and this application does not specifically limit this.
  • the mobile platform After the mobile platform determines the online grid map corresponding to each candidate positioning result, according to the multiple first height intervals in the offline high-precision map and the multiple second online grid maps corresponding to each candidate positioning result In the height interval, the movable platform is positioned, and the first positioning result of the movable platform is obtained.
  • the movable platform By positioning the movable platform through multiple first height intervals in the offline high-precision map and multiple second height intervals in each online raster map, accurate positioning results can be obtained, and the high-precision map positioning results can be improved Accuracy and stability.
  • step S103 specifically includes: sub-steps S1031 to S1032.
  • the state of the first height interval and the second height interval includes an occupied state and an unoccupied state. There is a three-dimensional point cloud in the first height interval or the second height interval in the occupied state, and the first height interval in the unoccupied state Or there is no three-dimensional point cloud in the second height interval.
  • the state comparison results include different states, all occupied states, and all non-occupied states.
  • the preset state comparison result is "all occupied states”.
  • the method for determining the matching degree corresponding to each candidate positioning result is specifically: determining each second height interval in each online non-ground height layer, and the corresponding second height interval in the offline non-ground height layer The state comparison result between a height interval; count the number of the state comparison results in each online non-ground height layer as the preset state comparison result in the second height interval; according to each online non-ground height layer
  • the status comparison result is the number of the second height interval of the preset status comparison result, and the matching degree of each candidate positioning result is determined, that is, the status comparison result in each online non-ground height layer is the preset status comparison result
  • the number of the second height interval is used as the matching degree of each candidate positioning result.
  • the offline high-precision map includes an offline non-ground height layer, a plurality of first height intervals are located in an offline non-ground height layer, the online raster map includes an online non-ground height layer, and the plurality of second height intervals are located in an online non-ground height layer. Height layer.
  • the end point heights of the first height interval located in the offline non-ground height layer and the second height interval located in the online non-ground height layer are greater than or equal to the set height threshold, and the height threshold can be set based on actual conditions. This is not specifically limited.
  • the height threshold is 1 meter
  • the height of 26 meters is divided, and the first height interval obtained is [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 6 second height intervals
  • the height of 26 meters is divided, and the second height intervals obtained are [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 6 second height intervals.
  • the method for determining the state comparison result between the first height interval and the corresponding second height interval is specifically: acquiring the first state identification information of each first height interval in the offline non-ground height layer and acquiring The second state identification information of each second height interval of each online non-ground height layer; according to the first state identification information and each second state identification information, each second state identification information in each online non-ground height layer is determined
  • the height interval is the state comparison result with the corresponding first height interval in the offline non-ground height layer.
  • the first state identification information includes the state identifier corresponding to each first altitude interval
  • the second state identification information includes the state identifier corresponding to each second altitude interval, the state identifier, and the state represented by the state identifier.
  • the height interval with a state identifier of 0 is in a non-occupied state
  • the height interval with a state identifier of 1 is in an occupied state.
  • the state identifier corresponding to each first altitude interval in the first state identification information is logically ANDed with the state identifier corresponding to the second altitude interval in the second state identification information, so as to obtain each online
  • the state comparison result between each second height interval in the non-ground height layer and the corresponding first height interval in the offline non-ground height layer For example, if the first height interval and the second height interval are both 7, and the first state identification information is 1010101, and the second state identification information is 0111101, then the logical AND processing of 1010101 and 0111101 is performed bitwise, and the result is 0010100. Then the state comparison results between the 7 second height intervals and the corresponding first height intervals are different states, different states, different states, all occupied states, different states, all occupied states, and different states.
  • the movable platform After determining the matching degree of each candidate positioning result, the movable platform determines the first positioning result of the movable platform from the candidate positioning result set according to the corresponding matching degree of each candidate positioning result, that is, the one with the highest matching degree.
  • the candidate positioning result is used as the first positioning result of the movable platform.
  • the online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set, and the raster map corresponding to each candidate positioning result is obtained.
  • the multiple height intervals in the accuracy map and the multiple height intervals in each online raster map are used to locate the movable platform, so that the movable platform can also be located in some scenes with sparse features or lack of obvious features. It can improve the accuracy and stability of high-precision map positioning results.
  • FIG. 3 is a schematic flowchart of the steps of another high-precision map positioning method provided by an embodiment of the present application.
  • the high-precision map positioning method includes steps S201 to S205.
  • the mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data.
  • the lidar can determine the 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 light on the object, and the emission direction of the laser at the laser emission point.
  • the three-dimensional point cloud data of objects around the movable platform includes 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 Determine a candidate positioning result set, and perform rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set, to obtain an online raster map corresponding to each candidate positioning result.
  • the online grid map includes a plurality of second height intervals.
  • the mobile platform determines the candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, in the online point cloud map Mark each candidate positioning result in the candidate positioning result set, and perform rasterization processing on the map area around each marked candidate positioning result, so that a grid map corresponding to each candidate positioning result can be obtained.
  • the mobile platform After the mobile platform determines the online grid map corresponding to each candidate positioning result, according to the multiple first height intervals in the offline high-precision map and the multiple second online grid maps corresponding to each candidate positioning result In the height interval, the movable platform is positioned, and the first positioning result of the movable platform is obtained.
  • the movable platform By positioning the movable platform through multiple first height intervals in the offline high-precision map and multiple second height intervals in each online raster map, accurate positioning results can be obtained, and the high-precision map positioning results can be improved Accuracy and stability.
  • the movable platform positions the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, and obtains the second positioning result of the movable platform.
  • the online raster map also includes an online complete height layer, the height of each raster in the online complete height layer is the average height of the three-dimensional point cloud in the raster;
  • the offline high-precision map also includes the offline complete height Layer, the height of each grid in this offline complete height layer is the average height of the 3D point cloud in the grid.
  • step S204 specifically includes: sub-steps S2041 to S2042.
  • the mobile platform obtains the corresponding partial offline complete height layer of each online complete height layer from the offline complete height layer; according to the height of each grid in each online complete height layer and the corresponding partial offline The height of each grid in the complete height layer, determine the loss cost between each online complete height layer and the corresponding partial offline complete height layer, and compare each online complete height layer with the corresponding partial offline complete height
  • the loss cost between layers is used as the matching degree of each candidate positioning result.
  • one candidate positioning result is selected from the candidate positioning result set as the second positioning result of the movable platform.
  • the method for determining the second positioning result is specifically as follows: the movable platform verifies the candidate positioning results in the candidate positioning result set according to the matching degree of each candidate positioning result; obtains each candidate positioning result that passes the verification Each corresponding degree of matching, and the candidate positioning result that passes the verification corresponding to the smallest degree of matching is used as the second positioning result of the movable platform.
  • the verification method of the candidate positioning result is specifically: determining whether the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold; if the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold, then determining the The candidate positioning result passes the verification, and if the matching degree of the candidate positioning result is greater than the preset matching degree threshold, it is determined that the candidate positioning result fails the verification.
  • the above-mentioned matching degree threshold can be set based on actual conditions, which is not specifically limited in this application. Using the candidate positioning result that has passed the verification corresponding to the smallest matching degree as the second positioning result of the movable platform can further improve the accuracy of the positioning result.
  • the movable platform After obtaining the first positioning result and the second positioning result of the movable platform, the movable platform merges the first positioning result and the second positioning result to obtain the target positioning result of the movable platform.
  • the accuracy and stability of the positioning results can be further improved.
  • the movable platform obtains the degree of matching of the first positioning result and the degree of matching 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, the degree of matching of the first positioning result is determined The first weight coefficient and the second weight coefficient of the second positioning result; the target positioning result of the movable platform is determined according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
  • the method for determining the first weighting coefficient and the second weighting coefficient is specifically: normalizing the matching degree of the first positioning result and the matching degree of the second positioning result; according to the matching degree of the processed first positioning result Determine the total matching degree according to the degree of matching with the processed second positioning result; determine the first weight coefficient of the first positioning result according to the processed first positioning result’s matching degree and the total matching degree; according to the processed second The matching degree of the positioning result and the total matching degree determine the second weight coefficient of the second positioning result.
  • the method for determining the weight coefficient is specifically: calculating the percentage of the matching degree of the processed first positioning result to the total matching degree, and using this percentage as the first weighting coefficient of the first positioning result; calculating the processed second positioning result
  • the matching degree of the result is the percentage of the total matching degree, and this percentage is used as the second weighting coefficient of the second positioning result.
  • the method for determining the target positioning result is specifically: calculating the product of the first positioning result and the first weight coefficient to obtain the first weighted positioning result; calculating the product of the second positioning result and the second weighting coefficient to obtain the second weighted positioning result ; Calculate the sum of the first weight positioning result and the second weight positioning result, and use the sum of the first weight positioning result and the second weight positioning result as the target positioning result of the movable platform.
  • the online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set, and the raster map corresponding to each candidate positioning result is obtained.
  • Multiple height intervals in the accuracy map and multiple height intervals in each online raster map are used to locate the movable platform, and at the same time through each candidate positioning result corresponding online full height layer and offline full height layer Positioning the movable platform and finally fusing the two positioning results can further improve the accuracy and stability of the positioning results.
  • FIG. 5 is a schematic flowchart of the steps of another high-precision map positioning method according to an embodiment of the present application.
  • the high-precision map positioning method includes steps S301 to S305.
  • the mobile platform uses high-precision lidar to collect three-dimensional point cloud data from the traveled area, and uses high-precision inertial navigation system and point cloud registration algorithm to process the collected three-dimensional point cloud data to generate offline high Accuracy map.
  • the mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data.
  • the lidar can determine the 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 light on the object, and the emission direction of the laser at the laser emission point.
  • the three-dimensional point cloud data of objects around the movable platform includes 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 offline high-precision map includes an offline complete height layer and an offline non-ground height layer.
  • the height of each grid in the offline complete height layer is the average height of the three-dimensional point cloud in the grid.
  • the offline non-ground height map The layer includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud.
  • the height interval value of each height interval can be the same or different.
  • the height interval value is the height difference between the two ends of the height interval. .
  • the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application. For example, if the height is 26 meters, the height intervals divided in the offline non-ground height layer are [1, 5), [5, 9), [9, 14), [14, 18), [18, 22 ) And [22,26] total 6 first height intervals.
  • S302. Determine a candidate positioning result set, and perform rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online raster map corresponding to each candidate positioning result.
  • the online raster map includes an online complete height layer and an online non-ground height layer.
  • the mobile platform determines the candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, in the online point cloud map Mark each candidate positioning result in the candidate positioning result set, and perform rasterization processing on the map area around each marked candidate positioning result, so that a grid map corresponding to each candidate positioning result can be obtained.
  • the online raster map includes the online full height layer and the online non-ground height layer.
  • the height of each grid in the online full height layer is the average height of the three-dimensional point cloud in the grid.
  • This online non-ground height layer It includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud.
  • the height interval value of each height interval may be the same or different.
  • the height interval value is the height difference between the two end points of the height interval. It should be noted that the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application.
  • the method for determining the candidate positioning result set is specifically: obtaining the current position data and current attitude data of the movable platform; determining the candidate position set according to the current position data; determining the candidate position set according to the current attitude data and the preset attitude error value Pose set: Determine the candidate positioning result set according to the candidate position set and the candidate pose set.
  • the current position data of the movable platform is the position data output by the positioning system of the movable platform at the current moment
  • the current posture data of the movable platform is the posture data output by the inertial measurement unit of the movable platform at the current moment.
  • the position data includes the geographic coordinates of the movable platform
  • the attitude data includes the pitch angle, roll angle, and yaw angle of the movable platform.
  • the method for determining the candidate location set is specifically as follows: the movable platform determines the change trend of the current location data, and determines the candidate location set according to the change trend of the current location data.
  • the change trend can be characterized by the gradient value and gradient direction of the current position data, that is, a preset unit gradient is used to obtain a preset number of candidate gradient values along the gradient direction based on the gradient value, and determine The position information corresponding to each candidate gradient value is used to determine the candidate position set.
  • the preset unit gradient and the preset number can be set based on actual conditions, which is not specifically limited in this application.
  • the method for determining the candidate pose set may be: calculating the difference between the pose angle in the current pose data and the preset pose error value, and calculating the sum of the pose angle in the current pose data and the preset pose error value , And then based on the difference 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, determine the candidate attitude set, that is, the attitude angle and the preset attitude error The difference of is one end point, and the sum of the attitude angle and the preset attitude error value is the other end point to obtain the candidate attitude angle range, and obtain multiple candidate attitude angles from the candidate attitude angle range in the preset unit attitude angle , So as to form a set of candidate poses.
  • the above-mentioned preset attitude error value and unit attitude angle can be set based on actual conditions, which is not specifically limited in this application.
  • the current pose data and preset pose error values can quickly and accurately determine the candidate pose set.
  • the movable platform locates the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain the first positioning result. Specifically, determine the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result; according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result For the matching degree between the height layers, the first positioning result is determined from the candidate positioning result set, that is, the candidate positioning result with the highest matching degree is used as the first positioning result of the movable platform.
  • the positioning result of the movable platform can be obtained, which improves the accuracy and stability of the positioning result Sex.
  • the height interval in the offline non-ground height layer is recorded as the first height interval
  • the height interval in the online non-ground height layer is recorded as the second height interval
  • the first height interval is the same as the corresponding second height interval .
  • the movable platform determines the status comparison results between each second height interval in each online non-ground height layer and the corresponding first height interval in the offline non-ground height layer;
  • the state comparison result in the online non-ground height layer is the number of the second height interval of the preset state comparison result;
  • the state comparison result in each online non-ground height layer is the second height interval of the preset state comparison result The number is used as the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result.
  • the state of the first height interval and the second height interval includes an occupied state and an unoccupied state.
  • the state comparison results include different states, all occupied states, and all non-occupied states.
  • the preset state comparison result is "all occupied states”.
  • the method for determining the state comparison result between the first height interval and the corresponding second height interval is specifically: acquiring the first state identification information of each first height interval in the offline non-ground height layer and acquiring The second state identification information of each second height interval of each online non-ground height layer; according to the first state identification information and each second state identification information, each second state identification information in each online non-ground height layer is determined
  • the height interval is the state comparison result with the corresponding first height interval in the offline non-ground height layer.
  • the first state identification information includes the state identifier corresponding to each first altitude interval
  • the second state identification information includes the state identifier corresponding to each second altitude interval, the state identifier, and the state represented by the state identifier.
  • the height interval with a state identifier of 0 is in a non-occupied state
  • the height interval with a state identifier of 1 is in an occupied state.
  • the state identifier corresponding to each first altitude interval in the first state identification information is logically ANDed with the state identifier corresponding to the second altitude interval in the second state identification information, so as to obtain each online
  • the state comparison result between each second height interval in the non-ground height layer and the corresponding first height interval in the offline non-ground height layer For example, if the first height interval and the second height interval are both 7, and the first state identification information is 1010101, and the second state identification information is 0111101, then the logical AND processing of 1010101 and 0111101 is performed bitwise, and the result is 0010100. Then the state comparison results between the 7 second height intervals and the corresponding first height intervals are different states, different states, different states, all occupied states, different states, all occupied states, and different states.
  • the movable platform positions the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, and obtains the second positioning result of the movable platform. Specifically, according to the online complete height layer and offline complete height layer corresponding to each candidate positioning result, the corresponding matching degree of each candidate positioning result is determined; according to the matching degree of each candidate positioning result, from the candidate The positioning result centrally determines the second positioning result.
  • the mobile platform obtains the local offline complete height layer corresponding to each online complete height layer from the offline complete height layer; according to the height and correspondence of each grid in each online complete height layer The height of each grid in the local offline complete height layer, determine the loss cost between each online complete height layer and the corresponding local offline complete height layer, and compare each online complete height layer with the corresponding local The loss cost between offline complete height layers is used as the matching degree of each candidate positioning result.
  • the method for determining the second positioning result is specifically as follows: the movable platform verifies the candidate positioning results in the candidate positioning result set according to the matching degree of each candidate positioning result; obtains each candidate positioning result that passes the verification Each corresponding degree of matching, and the candidate positioning result that passes the verification corresponding to the smallest degree of matching is used as the second positioning result of the movable platform.
  • the verification method of the candidate positioning result is specifically: determining whether the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold; if the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold, then determining the The candidate positioning result passes the verification, and if the matching degree of the candidate positioning result is greater than the preset matching degree threshold, it is determined that the candidate positioning result fails the verification.
  • the above-mentioned matching degree threshold can be set based on actual conditions, which is not specifically limited in this application. Using the candidate positioning result that has passed the verification corresponding to the smallest matching degree as the second positioning result of the movable platform can further improve the accuracy of the positioning result.
  • the target positioning result of the movable platform is determined according to the first positioning result and the second positioning result.
  • the movable platform obtains the degree of matching of the first positioning result and the degree of matching 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, the degree of matching of the first positioning result is determined The first weight coefficient and the second weight coefficient of the second positioning result; the target positioning result of the movable platform is determined according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
  • the method for determining the first weighting coefficient and the second weighting coefficient is specifically: normalizing the matching degree of the first positioning result and the matching degree of the second positioning result; according to the matching degree of the processed first positioning result Determine the total matching degree according to the degree of matching with the processed second positioning result; determine the first weight coefficient of the first positioning result according to the processed first positioning result’s matching degree and the total matching degree; according to the processed second The matching degree of the positioning result and the total matching degree determine the second weight coefficient of the second positioning result.
  • the method for determining the weight coefficient is specifically: calculating the percentage of the matching degree of the processed first positioning result to the total matching degree, and using this percentage as the first weighting coefficient of the first positioning result; calculating the processed second positioning result
  • the matching degree of the result is the percentage of the total matching degree, and this percentage is used as the second weighting coefficient of the second positioning result.
  • the method for determining the target positioning result is specifically: calculating the product of the first positioning result and the first weight coefficient to obtain the first weighted positioning result; calculating the product of the second positioning result and the second weighting coefficient to obtain the second weighted positioning result ; Calculate the sum of the first weight positioning result and the second weight positioning result, and use the sum of the first weight positioning result and the second weight positioning result as the target positioning result of the movable platform.
  • the online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set, and the raster map corresponding to each candidate positioning result is obtained.
  • the ground height layer and the online non-ground height layer in each raster map are used to locate the movable platform to obtain a positioning result.
  • the movable platform is positioned, and another positioning result is obtained.
  • the final positioning result of the movable platform is jointly determined by the two positioning results, so that the movable platform can also be tested in some scenes with sparse features or lack of obvious features. Positioning can improve the accuracy and stability of high-precision map positioning results.
  • FIG. 6 is a schematic flowchart of the steps of yet another high-precision map positioning method according to an embodiment of the present application.
  • the high-precision map positioning method includes steps S401 to S407.
  • the mobile platform uses high-precision lidar to collect three-dimensional point cloud data from the traveled area, and uses high-precision inertial navigation system and point cloud registration algorithm to process the collected three-dimensional point cloud data to generate offline high Accuracy map.
  • the mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data.
  • the offline high-precision map includes an offline complete height layer and an offline non-ground height layer.
  • the height of each grid in the offline complete height layer is the average height of the three-dimensional point cloud in the grid.
  • the offline non-ground height map The layer includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud.
  • the height interval value of each height interval can be the same or different.
  • the height interval value is the height difference between the two ends of the height interval. .
  • the historical positioning result of the movable platform is acquired, and the historical positioning result is the positioning result determined by the movable platform at the previous time, and the previous time and the current time are separated by a preset time.
  • the aforementioned preset time can be set based on actual conditions, which is not specifically limited in this application.
  • each candidate positioning result set that is, each candidate position is selected from the candidate position set and combined with each candidate pose in the candidate pose set until the candidate positions in the candidate position set are selected once At this time, each candidate positioning result obtained by the collection and combination is used as a candidate positioning result set.
  • preset unit gradient preset number
  • preset attitude error value preset unit attitude angle
  • the method for determining the candidate positioning result set may be: obtaining historical position coordinates and historical attitude angles from the historical positioning results, and calculating the differences between the historical position coordinates and historical attitude angles and the preset positioning error values. And calculate the sum of the historical position coordinates and the historical attitude angle respectively with the preset positioning error value, and then determine the candidate coordinate set based on the difference and the sum of the historical position coordinates and the preset positioning error value, and based on the historical attitude angle and the preset positioning error The difference and the sum of the values determine the candidate pose set, and finally based on the candidate coordinate set and the candidate pose set, determine the candidate positioning result set.
  • the above-mentioned preset positioning error value can be set based on actual conditions, which is not specifically limited in this application.
  • the mobile platform rasterizes the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, mark the candidate positioning result set in the online point cloud map For each candidate positioning result, rasterize the map area around each marked candidate positioning result to obtain a grid map corresponding to each candidate positioning result.
  • the online raster map includes the online full height layer and the online non-ground height layer.
  • the height of each grid in the online full height layer is the average height of the three-dimensional point cloud in the grid.
  • This online non-ground height layer It includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud.
  • the height interval value of each height interval may be the same or different.
  • the height interval value is the height difference between the two end points of the height interval.
  • the mobile platform After the mobile platform determines the online grid map corresponding to each candidate positioning result, according to the multiple first height intervals in the offline high-precision map and the multiple second online grid maps corresponding to each candidate positioning result In the height interval, the movable platform is positioned, and the first positioning result of the movable platform is obtained.
  • the movable platform By positioning the movable platform through multiple first height intervals in the offline high-precision map and multiple second height intervals in each online raster map, accurate positioning results can be obtained, and the high-precision map positioning results can be improved Accuracy and stability.
  • S406 Position the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result.
  • the movable platform positions the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, and obtains the second positioning result of the movable platform. Specifically, according to the online complete height layer and offline complete height layer corresponding to each candidate positioning result, the corresponding matching degree of each candidate positioning result is determined; according to the matching degree of each candidate positioning result, from the candidate The positioning result centrally determines the second positioning result.
  • S407 Determine a target positioning result of the movable platform according to the first positioning result and the second positioning result.
  • the target positioning result of the movable platform is determined according to the first positioning result and the second positioning result.
  • the movable platform obtains the degree of matching of the first positioning result and the degree of matching 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, the degree of matching of the first positioning result is determined The first weight coefficient and the second weight coefficient of the second positioning result; the target positioning result of the movable platform is determined according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
  • the high-precision map positioning method can accurately determine the candidate positioning result set through historical positioning results and positioning error values, and perform an online point cloud map based on each candidate positioning result in the accurate candidate positioning result set.
  • Rasterization process get the raster map corresponding to each candidate positioning result, use the offline non-ground height layer and the online non-ground height layer in each raster map to locate the movable platform to obtain a positioning
  • the mobile platform is positioned through the offline complete height layer and the online complete height layer in each raster map at the same time, and another positioning result is obtained.
  • the final position of the movable platform is determined by the two positioning results.
  • the positioning result makes it possible to locate the movable platform in some scenes with sparse features or lack of obvious features, which can improve the accuracy and stability of the high-precision map positioning result.
  • FIG. 7 is a schematic block diagram of a driving system provided by an embodiment of the present application.
  • the driving system includes an unmanned driving system and a manned driving system.
  • the driving system 500 includes a processor 501, a memory 502, and a lidar 503.
  • the processor 501, the memory 502, and the lidar 503 are connected by a bus 504, such as an I2C (Inter-integrated Circuit) bus.
  • I2C Inter-integrated Circuit
  • the processor 501 may be a micro-controller unit (MCU), a central processing unit (CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
  • MCU micro-controller unit
  • CPU central processing unit
  • DSP Digital Signal Processor
  • the memory 502 may be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk, or a mobile hard disk.
  • the processor 501 and the memory 502 are the computing platform of the driving system
  • the lidar 303 may be an external device of the driving system or an internal component of the driving system, which is not specifically limited in this application.
  • the processor 501 is configured to run a computer program stored in the memory 502, and implement the steps of the high-precision map positioning method as described above when the computer program is executed.
  • FIG. 8 is a schematic block diagram of a movable platform provided by an embodiment of the present application.
  • the mobile platform 800 includes a processor 601, a memory 602, and a lidar 603.
  • the processor 801, the memory 602, and the lidar 603 are connected by a bus 604, which is, for example, an I2C (Inter-integrated Circuit) bus.
  • movable platforms include vehicles and aircraft, aircraft include unmanned aerial vehicles and manned aerial vehicles, vehicles include manned vehicles and unmanned vehicles, etc.
  • Unmanned aerial vehicles include rotary-wing unmanned aerial vehicles, such as four-rotor unmanned aerial vehicles and hexarotors.
  • the processor 601 may be a micro-controller unit (MCU), a central processing unit (CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
  • MCU micro-controller unit
  • CPU central processing unit
  • DSP Digital Signal Processor
  • the memory 602 may be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk, or a mobile hard disk.
  • the processor 601 and the memory 602 are the computing platform 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 specifically limited in this application.
  • the processor 601 is configured to run a computer program stored in the memory 602, and implement the steps of the high-precision map positioning method as described above when the computer program is executed.
  • the embodiments of the present application also provide a computer-readable storage medium, the computer-readable storage medium stores a computer program, the computer program includes program instructions, and the processor executes the program instructions to implement the foregoing implementation The steps of the high-precision map positioning method provided in the example.
  • the computer-readable storage medium may be the internal storage unit of the driving system or the movable platform described in any of the foregoing embodiments, for example, the hard disk or memory of the driving system or the movable platform.
  • the computer-readable storage medium may also be an external storage device of the driving system or a removable platform, for example, a plug-in hard disk or a smart memory card (Smart Media Card, SMC) equipped on the driving system or the removable platform. , Secure Digital (SD) card, Flash Card (Flash Card), etc.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

Provided are a high-precision map positioning method and system, a platform, and a computer-readable storage medium. The method comprises: acquiring an offline high-precision map, and establishing an online point cloud map; performing rasterization processing on the online point cloud map to obtain a plurality of online raster maps; and performing positioning on a mobile platform according to height intervals in the plurality of online raster maps and height intervals in the offline high-precision map. According to the method, the positioning accuracy is improved.

Description

高精度地图定位方法、系统、平台及计算机可读存储介质High-precision map positioning method, system, platform and computer readable storage medium 技术领域Technical field
本申请涉及高精度地图的技术领域,尤其涉及一种高精度地图定位方法、系统、平台及计算机可读存储介质。This application relates to the technical field of high-precision maps, and in particular to a high-precision map positioning method, system, platform, and computer-readable storage medium.
背景技术Background technique
随着地图技术的发展,高精度地图开始在越来越多的领域被使用。通常,高精度地图定位是通过可移动平台所搭载的传感器获取周围环境并得到周围环境的一些特征信息,然后将这些特征信息与高精度地图中的特征信息进行匹配,从而得到可移动平台在高精度地图中的定位。With the development of map technology, high-precision maps have begun to be used in more and more fields. Generally, high-precision map positioning is to obtain the surrounding environment and some characteristic information of the surrounding environment through the sensors mounted on the mobile platform, and then match these characteristic information with the characteristic information in the high-precision map, so as to obtain the mobile platform at high altitude. Positioning in the accuracy map.
但是,由于这种特征匹配比较依赖周围环境的信息丰富程度,在一些特征稀疏或者缺乏明显特征的场景下可能出现无法定位的情况;以及对于一些环境中存在重复性特征的情况下,可能出现错误的匹配结果。因此,如何提高高精度地图定位结果的准确性和稳定性是目前亟待解决的问题。However, because this feature matching is more dependent on the richness of the surrounding environment, it may not be able to locate in some scenes with sparse features or lack of obvious features; and for some environments where there are repetitive features, errors may occur. The matching result. Therefore, how to improve the accuracy and stability of the high-precision map positioning result is an urgent problem to be solved at present.
发明内容Summary of the invention
基于此,本申请提供了一种高精度地图定位方法、系统、平台及计算机可读存储介质,旨在提高高精度地图定位结果的准确性和稳定性。Based on this, this application provides a high-precision map positioning method, system, platform, and computer-readable storage medium, aiming to improve the accuracy and stability of the high-precision map positioning result.
第一方面,本申请提供了一种高精度地图定位方法,包括:In the first aspect, this application provides a high-precision map positioning method, including:
获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间;Acquiring an offline high-precision map and establishing an online point cloud map, where the offline high-precision map includes a plurality of first height intervals;
确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间;Determine the candidate positioning result set, and perform 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 includes a plurality of second height intervals;
根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。According to the plurality of first height intervals in the offline high-precision map and the plurality of second height intervals in the online grid map corresponding to each candidate positioning result, the movable platform is positioned to obtain the The first positioning result of the mobile platform.
第二方面,本申请还提供了一种高精度地图定位方法,包括:In the second aspect, this application also provides a high-precision map positioning method, including:
获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层;Obtain an offline high-precision map, and establish an online point cloud map, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer;
确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层;Determine the candidate positioning result set, and perform 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. Online raster map includes online complete height layer and online non-ground height layer;
根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果;以及Positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result; and
根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result;
根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。According to the first positioning result and the second positioning result, the target positioning result of the movable platform is determined.
第三方面,本申请还提供了一种驾驶系统,所述驾驶系统包括激光雷达、存储器和处理器;所述存储器用于存储计算机程序;In a third aspect, the present application also provides a driving system, the driving system includes a lidar, a memory, and a processor; the memory is used to store a computer program;
所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间;Acquiring an offline high-precision map, and establishing an online point cloud map through the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes a plurality of first height intervals;
确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间;Determine the candidate positioning result set, and perform 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 includes a plurality of second height intervals;
根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。According to the multiple second height intervals in the online grid map and the multiple first height intervals in the offline high-precision map corresponding to each candidate positioning result, the movable platform is positioned to obtain the The first positioning result of the mobile platform.
第四方面,本申请还提供了一种驾驶系统,所述驾驶系统包括激光雷达、存储器和处理器;所述存储器用于存储计算机程序;In a fourth aspect, the present application also provides a driving system, the driving system includes a lidar, a memory, and a processor; the memory is used to store a computer program;
所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层;Acquiring an offline high-precision map, and establishing an online point cloud map from the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer;
确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线 栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层;Determine the candidate positioning result set, and perform 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. Online raster map includes online complete height layer and online non-ground height layer;
根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果;以及Positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result; and
根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result;
根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。According to the first positioning result and the second positioning result, the target positioning result of the movable platform is determined.
第五方面,本申请还提供了一种可移动平台,所述可移动平台包括激光雷达、存储器和处理器;所述存储器用于存储计算机程序;In a fifth aspect, the present application also provides a movable platform, the movable platform includes a lidar, a memory, and a processor; the memory is used to store a computer program;
所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间;Acquiring an offline high-precision map, and establishing an online point cloud map through the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes a plurality of first height intervals;
确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间;Determine the candidate positioning result set, and perform 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 includes a plurality of second height intervals;
根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。According to the multiple second height intervals in the online grid map and the multiple first height intervals in the offline high-precision map corresponding to each candidate positioning result, the movable platform is positioned to obtain the The first positioning result of the mobile platform.
第六方面,本申请还提供了一种可移动平台,所述可移动平台包括激光雷达、存储器和处理器;所述存储器用于存储计算机程序;In a sixth aspect, the present application also provides a movable platform, the movable platform includes a lidar, a memory, and a processor; the memory is used to store a computer program;
所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层;Acquiring an offline high-precision map, and establishing an online point cloud map from the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer;
确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层;Determine the candidate positioning result set, and perform 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. Online raster map includes online complete height layer and online non-ground height layer;
根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果;以及Positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result; and
根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整 高度图层,对可移动平台进行定位,得到第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result;
根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。According to the first positioning result and the second positioning result, the target positioning result of the movable platform is determined.
第七方面,本申请还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如上所述的高精度地图定位方法。In a seventh aspect, the present application also provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor achieves the above-mentioned high precision Map positioning method.
本申请实施例提供了一种高精度地图定位方法、系统、平台及计算机可读存储介质,通过候选定位结果集中的每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,通过离线高精度地图中的多个高度区间和每个在线栅格地图中的多个高度区间,对可移动平台进行定位,使得在一些特征稀疏或者缺乏明显特征的场景下也可以对可移动平台进行定位,能够提高高精度地图定位结果的准确性和稳定性。The embodiments of the application provide a high-precision map positioning method, system, platform, and computer-readable storage medium. The online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set to obtain each The online raster map corresponding to the candidate positioning results, through the multiple height intervals in the offline high-precision map and the multiple height intervals in each online raster map, to locate the movable platform, so that some features are sparse or lacking. The mobile platform can also be positioned in the scene with obvious characteristics, which can improve the accuracy and stability of the high-precision map positioning result.
应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本申请。It should be understood that the above general description and the following detailed description are only exemplary and explanatory, and cannot limit the application.
附图说明Description of the drawings
为了更清楚地说明本申请实施例技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to explain the technical solutions of the embodiments of the present application more clearly, the following will briefly introduce the drawings used in the description of the embodiments. Obviously, the drawings in the following description are some embodiments of the present application. Ordinary technicians can obtain other drawings based on these drawings without creative work.
图1是本申请一实施例提供的一种高精度地图定位方法的步骤示意流程图;FIG. 1 is a schematic flowchart of the steps of a high-precision map positioning method provided by an embodiment of the present application;
图2是图1中的高精度地图定位方法的子步骤示意流程图;FIG. 2 is a schematic flowchart of sub-steps of the high-precision map positioning method in FIG. 1;
图3是本申请一实施例提供的另一种高精度地图定位方法的步骤示意流程图;3 is a schematic flowchart of steps of another high-precision map positioning method provided by an embodiment of the present application;
图4是图3中的高精度地图定位方法的子步骤示意流程图;4 is a schematic flowchart of sub-steps of the high-precision map positioning method in FIG. 3;
图5是本申请一实施例提供的另一种高精度地图定位方法的步骤示意流程图;5 is a schematic flowchart of steps of another high-precision map positioning method provided by an embodiment of the present application;
图6是本申请一实施例提供的另一种高精度地图定位方法的步骤示意流程图;FIG. 6 is a schematic flowchart of the steps of another high-precision map positioning method provided by an embodiment of the present application;
图7是本申请一实施例提供的一种驾驶系统的结构示意性框图;FIG. 7 is a schematic block diagram of the structure of a driving system provided by an embodiment of the present application;
图8是本申请一实施例提供的一种可移动平台的结构示意性框图。FIG. 8 is a schematic block diagram of the structure of a movable platform provided by an embodiment of the present application.
具体实施方式detailed description
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The technical solutions in the embodiments of the present application will be described clearly and completely in conjunction with the accompanying drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of them. Based on the embodiments in this application, all other embodiments obtained by those of ordinary skill in the art without creative work shall fall within the protection scope of this application.
附图中所示的流程图仅是示例说明,不是必须包括所有的内容和操作/步骤,也不是必须按所描述的顺序执行。例如,有的操作/步骤还可以分解、组合或部分合并,因此实际执行的顺序有可能根据实际情况改变。The flowchart shown in the drawings is only an example, and does not necessarily include all contents and operations/steps, nor does it have to be executed in the described order. For example, some operations/steps can also be decomposed, combined or partially combined, so the actual execution order may be changed according to actual conditions.
下面结合附图,对本申请的一些实施方式作详细说明。在不冲突的情况下,下述的实施例及实施例中的特征可以相互组合。Hereinafter, some embodiments of the present application will be described in detail with reference to the accompanying drawings. In the case of no conflict, the following embodiments and features in the embodiments can be combined with each other.
请参阅图1,图1是本申请一实施例提供的一种高精度地图定位方法的步骤示意流程图。该高精度地图定位方法可以应用在可移动平台或驾驶系统中。其中可移动平台包括车辆和飞行器,飞行器包括无人飞行器和有人飞行器,车辆包括有人驾驶车辆和无人驾驶车辆等,无人飞行器包括旋翼型无人飞行器,例如四旋翼无人飞行器、六旋翼无人飞行器、八旋翼无人飞行器,也可以是固定翼无人飞行器,还可以是旋翼型与固定翼无人飞行器的组合,在此不作限定。Please refer to FIG. 1. FIG. 1 is a schematic flowchart of 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. Among them, movable platforms include vehicles and aircraft. Aircraft include unmanned aerial vehicles and manned aerial vehicles. Vehicles include manned and unmanned vehicles. Unmanned aerial vehicles include rotary-wing unmanned aerial vehicles, such as four-rotor unmanned aerial vehicles and six-rotor unmanned aerial vehicles. A human aircraft, an eight-rotor unmanned aerial vehicle, or a fixed-wing unmanned aerial vehicle, or a combination of a rotor-type and a fixed-wing unmanned aerial vehicle, is not limited here.
具体地,如图1所示,该高精度地图定位方法包括步骤S101至步骤S103。Specifically, as shown in FIG. 1, the high-precision map positioning method includes steps S101 to S103.
S101、获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间。S101. Obtain an offline high-precision map, and establish an online point cloud map, where the offline high-precision map includes a plurality of first height intervals.
其中,可移动平台通过高精度的激光雷达对行驶过的区域采集三维点云数据,并通过高精度惯导系统和点云配准算法,对采集到的三维点云数据进行处理,生成离线高精度地图。或者,通过高精度的激光雷达对行驶过的区域采集三维点云数据,通过惯性测量单元(Inertial Measurement Unit,IMU)采集可移动平台的姿态数据,以及通过全球定位系统(Global Positioning System,GPS)采集可移动平台的位置数据,然后基于姿态数据和位置数据,对采集到的三维点云数据进行校正处理,并基于校正后的三维点云数据生成离线高精度地图。Among them, the mobile platform uses high-precision lidar to collect three-dimensional point cloud data from the traveled area, and uses high-precision inertial navigation system and point cloud registration algorithm to process the collected three-dimensional point cloud data to generate offline high Accuracy map. Or, use high-precision lidar to collect three-dimensional point cloud data from the traveled area, use the Inertial Measurement Unit (IMU) to collect the attitude data of the movable platform, and use the Global Positioning System (GPS) Collect the position data of the movable platform, then correct the collected 3D point cloud data based on the posture data and the position data, and generate an offline high-precision map based on the corrected 3D point cloud data.
可移动平台在移动过程中,获取离线高精度地图,并通过激光雷达实时采集可移动平台周围物体的三维点云数据,且基于实时采集到的三维点云数据建立在线点云地图。其中,激光雷达可以基于激光发射点与发射出的激光在物体上的反射点的距离,以及激光发射点的激光的发射方向,确定物体的三维点云数据。可移动平台周边物体的三维点云数据包括物体与可移动平台的距离,物体与可移动平台的角度,以及物体的三维坐标等数据。The mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data. Among them, the lidar can determine the 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 light on the object, and the emission direction of the laser at the laser emission point. The three-dimensional point cloud data of objects around the movable platform includes 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.
其中,该离线高精度地图包括多个第一高度区间,该离线高精度地图中的每个栅格的高度分别位于对应的第一高度区间,且第一高度区间是按照三维点云的高度进行划分得到的,各第一高度区间的高度间隔值可以相同,也可以不相同,该高度间隔值为高度区间的两端点的高度差值。需要说明的是,高度间隔值和高度区间的数量可基于实际情况进行设置,本申请对此不作具体限定。例如,高度为26米,则划分得到的第一高度区间分别为[0,1)、[1,5)、[5,9)、[9,14)、[14,18)、[18,22)和[22,26]共计7个第一高度区间。Wherein, the offline high-precision map includes a plurality of first height intervals, the height of each grid in the offline high-precision map is located in the corresponding first height interval, and the first height interval is performed according to the height of the three-dimensional point cloud. According to the division, the height interval value of each first height interval may be the same or different, and the height interval value is the height difference between the two end points of the height interval. It should be noted that the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application. For example, if the height is 26 meters, the divided first height intervals are [0, 1), [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 7 first height intervals.
S102、确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间。S102. Determine a candidate positioning result set, and perform rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online raster map corresponding to each candidate positioning result. Wherein, the online grid map includes a plurality of second height intervals.
可移动平台确定候选定位结果集,并根据每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,即在该在线点云地图中标记该候选定位结果集中的每个候选定位结果,并对标记的每个候选定位结果周围的地图区域进行栅格化处理,可以得到每个候选定位结果各自对应的栅格地图。The mobile platform determines the candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, in the online point cloud map Mark each candidate positioning result in the candidate positioning result set, and perform rasterization processing on the map area around each marked candidate positioning result, so that a grid map corresponding to each candidate positioning result can be obtained.
其中,在线栅格地图包括多个第二高度区间,该在线栅格地图中的每个栅格的高度分别位于对应的第二高度区间,且第二高度区间是按照三维点云的高度进行划分得到的,各第二高度区间的高度间隔值可以相同,也可以不相同,该高度间隔值为高度区间的两端点的高度差值。需要说明的是,高度间隔值和高度区间的数量可基于实际情况进行设置,本申请对此不作具体限定。例如,高度为26米,则划分得到的第二高度区间分别为[0,1)、[1,5)、[5,9)、[9,14)、[14,18)、[18,22)和[22,26]共计7个第二高度区间。Wherein, the online grid map includes a plurality of second height intervals, the height of each grid in the online grid map is located in the corresponding second height interval, and the second height interval is divided according to the height of the three-dimensional point cloud Obtained, the height interval value of each second height interval may be the same or different, and the height interval value is the height difference value between the two end points of the height interval. It should be noted that the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application. For example, if the height is 26 meters, the divided second height intervals are [0, 1), [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 7 second height intervals.
需要说明的是,第一高度区间与第二高度区间的数量可以相同,也可以不相同,第一高度区间与第二高度区间具有对应关系,且具有对应关系的第一高度区间和第二高度区间的两端点相同,本申请对此不作具体限定。It should be noted that the number of the first height interval and the second height interval may be the same or different. The first height interval and the second height interval have a corresponding relationship, and there is a corresponding relationship between the first height interval and the second height interval. The two ends of the interval are the same, which is not specifically limited in this application.
在一实施例中,候选定位结果集的确定方式具体为:获取可移动平台的当前位置数据和当前姿态数据;根据当前位置数据确定候选位置集;根据当前姿态数据和预设姿态误差值确定候选姿态集;根据候选位置集和所述候选姿态集,确定候选定位结果集。其中,可移动平台的当前位置数据为可移动平台的定位系统在当前时刻输出的位置数据,可移动平台的当前姿态数据为可移动平台的惯性测量单元在当前时刻输出的姿态数据。该位置数据包括可移动平台的地理位置坐标,该姿态数据包括可移动平台的俯仰角、横滚角和偏航角。In an embodiment, the method for determining the candidate positioning result set is specifically: obtaining the current position data and current attitude data of the movable platform; determining the candidate position set according to the current position data; determining the candidate position set according to the current attitude data and the preset attitude error value Pose set: Determine the candidate positioning result set according to the candidate position set and the candidate pose set. Among them, the current position data of the movable platform is the position data output by the positioning system of the movable platform at the current moment, and the current posture data of the movable platform is the posture data output by the inertial measurement unit of the movable platform at the current moment. The position data includes the geographic coordinates of the movable platform, and the attitude data includes the pitch angle, roll angle, and yaw angle of the movable platform.
在一实施例中,根据当前位置数据确定候选位置集的方式具体为:可移动平台确定当前位置数据的变化趋势,并根据当前位置数据的变化趋势,确定候选位置集。具体地,可以通过当前位置数据的梯度值和梯度方向来表征变化趋势,即以预设的单位梯度,基于该梯度值,沿着该梯度方向,得到预设个数的候选梯度值,并确定每个候选梯度值各自对应的位置信息,从而确定候选位置集。需要说明的是,预设的单位梯度和预设个数可基于实际情况进行设置,本申请对此不作具体限定。In an embodiment, the method of determining the candidate location set according to the current location data is specifically as follows: the movable platform determines the change trend of the current location data, and determines the candidate location set according to the change trend of the current location data. Specifically, the change trend can be characterized by the gradient value and gradient direction of the current position data, that is, a preset unit gradient is used to obtain a preset number of candidate gradient values along the gradient direction based on the gradient value, and determine The position information corresponding to each candidate gradient value is used to determine the candidate position set. It should be noted that the preset unit gradient and the preset number can be set based on actual conditions, which is not specifically limited in this application.
在一实施例中,候选姿态集的确定方式可以为:计算当前姿态数据中的姿态角与预设姿态误差值的差值,并计算当前姿态数据中的姿态角与预设姿态误差值的和,然后基于当前姿态数据中的姿态角与预设姿态误差值的差值以及当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集,即以姿态角与预设姿态误的差值为一个端点,以姿态角与预设姿态误差值的和为另一个端点,得到候选姿态角范围,并以预设的单位姿态角从该候选姿态角范围中获取多个候选姿态角,从而形成候选姿态集。需要说明的是,上述预设姿态误差值和单位姿态角可基于实际情况进行设置,本申请对此不作具体限定。通过当前姿态数据和预设姿态误差值可以快速准确的确定候选姿态集。In an embodiment, the method for determining the candidate pose set may be: calculating the difference between the pose angle in the current pose data and the preset pose error value, and calculating the sum of the pose angle in the current pose data and the preset pose error value , And then based on the difference 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, determine the candidate attitude set, that is, the attitude angle and the preset attitude error The difference of is one end point, and the sum of the attitude angle and the preset attitude error value is the other end point to obtain the candidate attitude angle range, and obtain multiple candidate attitude angles from the candidate attitude angle range in the preset unit attitude angle , So as to form a set of candidate poses. It should be noted that the above-mentioned preset attitude error value and unit attitude angle can be set based on actual conditions, which is not specifically limited in this application. The current pose data and preset pose error values can quickly and accurately determine the candidate pose set.
在一实施例中,候选姿态集的确定方式还可以为:可移动平台根据当前位置数据,确定可移动平台在该离线高精度地图中的位置坐标,即从当前位置数据中获取可移动平台的地理位置坐标,并在该离线高精度地图中标记该地理位置坐标,然后获取该地理位置坐标周围物体在离线高精度地图中的位置坐标,并基于周围物体在离线高精度地图中的位置坐标,确定可移动平台在离线高精度地图中的位置坐标;根据该位置坐标和预设位置误差值,确定候选位置集。通过当前位置数据和预设位置误差值可以快速准确的确定候选位置集。In an embodiment, the method for determining the candidate pose set may also be: the movable platform determines the position coordinates of the movable platform in the offline high-precision map according to the current position data, that is, obtains the position coordinates of the movable platform from the current position data. Geographic location coordinates, and mark the geographic location coordinates in the offline high-precision map, and then obtain the location coordinates of objects around the geographic location coordinates in the offline high-precision map, and based on the location coordinates of surrounding objects in the offline high-precision map, Determine the position coordinates of the movable platform in the offline high-precision map; determine the candidate position set according to the position coordinates and the preset position error value. The candidate position set can be quickly and accurately determined through the current position data and the preset position error value.
在一实施例中,根据候选位置集和候选姿态集,确定候选定位结果集的方式具体为:可移动平台每次从候选位置集选择一个候选位置与候选姿态集中的每个候选姿态进行组合,直至候选位置集中的候选位置均被选择一次时,汇集组合得到的每个候选定位结果作为候选定位结果集。In an embodiment, according to the candidate position set and the candidate pose set, the method for determining the candidate positioning result set is specifically as follows: the movable platform selects one candidate position from the candidate position set each time to combine with each candidate pose in the candidate pose set, Until the candidate positions in the candidate position set are selected once, each candidate positioning result obtained by the collection and combination is used as the candidate positioning result set.
在一实施例中,候选定位结果集的确定方式还可以为:获取可移动平台的历史定位结果,并根据历史定位结果确定候选定位结果集。其中,历史定位结果为可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间。需要说明的是,上述预设时间可基于实际情况进行设置,本申请对此不作具体限定。In an embodiment, the method for determining the candidate positioning result set may also be: obtaining the historical positioning result of the movable platform, and determining the candidate positioning result set according to the historical positioning result. Wherein, the historical positioning result is the positioning result determined by the movable platform at the last moment, and the last moment and the current moment are separated by a preset time. It should be noted that the aforementioned preset time can be set based on actual conditions, which is not specifically limited in this application.
具体地,从该历史定位结果中获取历史位置坐标和历史姿态角;对历史位置坐标进行求导处理,以确定历史位置坐标的梯度值和梯度方向,并根据该梯度值和梯度方向,确定候选位置集,即以预设的单位梯度,基于该梯度值,沿着该梯度方向,得到预设个数的候选梯度值,并确定每个候选梯度值各自对应的位置信息,从而确定候选位置集;Specifically, obtain the historical position coordinates and historical attitude angle from the historical positioning results; perform derivative processing on the historical position coordinates to determine the gradient value and the gradient direction of the historical position coordinates, and determine the candidate according to the gradient value and the gradient direction Position set, that is, a preset number of candidate gradient values are obtained along the gradient direction based on the gradient value based on the preset unit gradient, and the position information corresponding to each candidate gradient value is determined, thereby determining the candidate position set ;
计算历史姿态角与预设姿态误差值的差值,并计算历史姿态角与预设姿态误差值的和;以历史姿态角与预设姿态误差值的差值为一个端点,以历史姿态角与预设姿态误差值的和为另一个端点,得到候选姿态角范围,并以预设的单位姿态角从该候选姿态角范围中获取多个候选姿态角,从而形成候选姿态集;Calculate the difference between the historical attitude angle and the preset attitude error value, and calculate the sum of the historical attitude angle and the preset attitude error value; take the difference between the historical attitude angle and the preset attitude error value as an endpoint, and use the historical attitude angle and The sum of the preset attitude error values is the other end point to obtain the candidate attitude angle range, and obtain multiple candidate attitude angles from the candidate attitude angle range in the preset unit attitude angle, thereby forming a candidate pose set;
根据该候选位置集和候选姿态集,确定候选定位结果集,即每次从候选位置集选择一个候选位置与候选姿态集中的每个候选姿态进行组合,直至候选位置集中的候选位置均被选择一次时,汇集组合得到的每个候选定位结果作为候选定位结果集。需要说明的是,上述预设的单位梯度、预设个数、预设姿态误差值和预设的单位姿态角可基于实际情况进行设置,本申请对此不作具体限定。According to the candidate position set and the candidate pose set, determine the candidate positioning result set, that is, each candidate position is selected from the candidate position set and combined with each candidate pose in the candidate pose set until the candidate positions in the candidate position set are selected once At this time, each candidate positioning result obtained by the collection and combination is used as a candidate positioning result set. It should be noted that the aforementioned preset unit gradient, preset number, preset attitude error value, and preset unit attitude angle can be set based on actual conditions, and this application does not specifically limit this.
S103、根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。S103. Position the movable platform according to the plurality of first height intervals in the offline high-precision map and the plurality of second height intervals in the online grid map corresponding to each candidate positioning result, to obtain all The first positioning result of the movable platform is described.
可移动平台确定每个候选定位结果各自对应的在线栅格地图之后,根据离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到可移动平台的第一定位结果。通过离线高精度地图中的多个第一高度区间和每个在线栅格地图中的多个第二高度区间,对可移动平台进行定位,可以得到准确的定位结果,能够提高高精度地图定位结果的准确性和稳定性。After the mobile platform determines the online grid map corresponding to each candidate positioning result, according to the multiple first height intervals in the offline high-precision map and the multiple second online grid maps corresponding to each candidate positioning result In the height interval, the movable platform is positioned, and the first positioning result of the movable platform is obtained. By positioning the movable platform through multiple first height intervals in the offline high-precision map and multiple second height intervals in each online raster map, accurate positioning results can be obtained, and the high-precision map positioning results can be improved Accuracy and stability.
在一实施例中,如图2所示,步骤S103具体包括:子步骤S1031至S1032。In an embodiment, as shown in FIG. 2, step S103 specifically includes: sub-steps S1031 to S1032.
S1031、根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,确定每个候选定位结果各自对应的匹配程度。S1031, according to the plurality of first height intervals in the offline high-precision map and the plurality of second height intervals in the online grid map corresponding to each candidate positioning result, determine the corresponding position of each candidate positioning result Matching degree.
具体地,确定每个在线栅格地图中的各第二高度区间,与离线高精度地图中对应的第一高度区间之间的状态比较结果;统计每个在线栅格地图中状态比较结果为预设状态比较结果的第二高度区间的个数,并将每个在线栅格地图中状态比较结果为预设状态比较结果的第二高度区间的个数,作为每个候选定位 结果各自对应的匹配程度。其中,第一高度区间和第二高度区间的状态包括占据状态和非占据状态,处于占据状态的第一高度区间或第二高度区间中存在三维点云,而处于非占据状态的第一高度区间或第二高度区间中不存在三维点云。其中,状态比较结果包括状态不同、均为占据状态和均为非占据状态。可选地,预设状态比较结果为“均为占据状态”。Specifically, determine the status comparison result between each second height interval in each online raster map and the corresponding first height interval in the offline high-precision map; statistics of the status comparison results in each online raster map are expected Set the number of the second height interval of the status comparison result, and use the status comparison result in each online grid map as the number of the second height interval of the preset status comparison result as the corresponding match of each candidate positioning result degree. Among them, the state of the first height interval and the second height interval includes an occupied state and an unoccupied state. There is a three-dimensional point cloud in the first height interval or the second height interval in the occupied state, and the first height interval in the unoccupied state Or there is no three-dimensional point cloud in the second height interval. Among them, the state comparison results include different states, all occupied states, and all non-occupied states. Optionally, the preset state comparison result is "all occupied states".
在一实施例中,每个候选定位结果各自对应的匹配程度的确定方式具体为:确定每个在线非地面高度图层中的各第二高度区间,与离线非地面高度图层中对应的第一高度区间之间的状态比较结果;统计每个在线非地面高度图层中所述状态比较结果为预设状态比较结果的第二高度区间的个数;根据每个在线非地面高度图层中状态比较结果为预设状态比较结果的第二高度区间的个数,确定每个候选定位结果各自对应的匹配程度,即将每个在线非地面高度图层中状态比较结果为预设状态比较结果的第二高度区间的个数,作为每个候选定位结果各自对应的匹配程度。In an embodiment, the method for determining the matching degree corresponding to each candidate positioning result is specifically: determining each second height interval in each online non-ground height layer, and the corresponding second height interval in the offline non-ground height layer The state comparison result between a height interval; count the number of the state comparison results in each online non-ground height layer as the preset state comparison result in the second height interval; according to each online non-ground height layer The status comparison result is the number of the second height interval of the preset status comparison result, and the matching degree of each candidate positioning result is determined, that is, the status comparison result in each online non-ground height layer is the preset status comparison result The number of the second height interval is used as the matching degree of each candidate positioning result.
其中,该离线高精度地图包括离线非地面高度层,多个第一高度区间位于离线非地面高度层,该在线栅格地图包括在线非地面高度层,该多个第二高度区间位于在线非地面高度层。其中,位于离线非地面高度层的第一高度区间和位于在线非地面高度层的第二高度区间的端点高度大于或等于设定的高度阈值,且高度阈值可基于实际情况进行设置,本申请对此不作具体限定。可选地,高度阈值为1米,则对26米的高度进行划分,得到的第一高度区间为[1,5)、[5,9)、[9,14)、[14,18)、[18,22)和[22,26]共计6个第二高度区间,则对26米的高度进行划分,得到的第二高度区间为[1,5)、[5,9)、[9,14)、[14,18)、[18,22)和[22,26]共计6个第二高度区间。Wherein, the offline high-precision map includes an offline non-ground height layer, a plurality of first height intervals are located in an offline non-ground height layer, the online raster map includes an online non-ground height layer, and the plurality of second height intervals are located in an online non-ground height layer. Height layer. Wherein, the end point heights of the first height interval located in the offline non-ground height layer and the second height interval located in the online non-ground height layer are greater than or equal to the set height threshold, and the height threshold can be set based on actual conditions. This is not specifically limited. Optionally, if the height threshold is 1 meter, the height of 26 meters is divided, and the first height interval obtained is [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 6 second height intervals, then the height of 26 meters is divided, and the second height intervals obtained are [1, 5), [5, 9), [9, 14), [14, 18), [18, 22) and [22, 26] total 6 second height intervals.
在一实施例中,第一高度区间与对应的第二高度区间之间的状态比较结果的确定方式具体为:获取离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个在线非地面高度图层的各第二高度区间的第二状态标识信息;根据第一状态标识信息与每个第二状态标识信息,确定每个在线非地面高度图层中的各第二高度区间,与离线非地面高度图层中对应的第一高度区间之间的状态比较结果。其中,第一状态标识信息包括每个第一高度区间各自对应的状态标识符,第二状态标识信息包括每个第二高度区间各自对应的状态标识符,状态标识符以及状态标识符代表的状态可基于实际情况进行设置,本申请对此不作具体限定。可选地,状态标识符为0的高度区间处于非占据状态,状态标识符为1的高度区间处于占据状态。In an embodiment, the method for determining the state comparison result between the first height interval and the corresponding second height interval is specifically: acquiring the first state identification information of each first height interval in the offline non-ground height layer and acquiring The second state identification information of each second height interval of each online non-ground height layer; according to the first state identification information and each second state identification information, each second state identification information in each online non-ground height layer is determined The height interval is the state comparison result with the corresponding first height interval in the offline non-ground height layer. Wherein, the first state identification information includes the state identifier corresponding to each first altitude interval, and the second state identification information includes the state identifier corresponding to each second altitude interval, the state identifier, and the state represented by the state identifier. It can be set based on actual conditions, which is not specifically limited in this application. Optionally, the height interval with a state identifier of 0 is in a non-occupied state, and the height interval with a state identifier of 1 is in an occupied state.
具体地,将第一状态标识信息中每个第一高度区间各自对应的状态标识符,与第二状态标识信息中对应第二高度区间的状态标识符进行逻辑与处理,从而可以得到每个在线非地面高度图层中的各第二高度区间,与离线非地面高度图层中对应的第一高度区间之间的状态比较结果。例如,第一高度区间和第二高度区间均为7个,且第一状态标识信息为1010101,第二状态标识信息为0111101,则按位对1010101和0111101进行逻辑与处理,得到结果为0010100,则7个第二高度区间,与对应的第一高度区间之间的状态比较结果分别为状态不同、状态不同、状态不同、均为占据状态、状态不同、均为占据状态和状态不同。Specifically, the state identifier corresponding to each first altitude interval in the first state identification information is logically ANDed with the state identifier corresponding to the second altitude interval in the second state identification information, so as to obtain each online The state comparison result between each second height interval in the non-ground height layer and the corresponding first height interval in the offline non-ground height layer. For example, if the first height interval and the second height interval are both 7, and the first state identification information is 1010101, and the second state identification information is 0111101, then the logical AND processing of 1010101 and 0111101 is performed bitwise, and the result is 0010100. Then the state comparison results between the 7 second height intervals and the corresponding first height intervals are different states, different states, different states, all occupied states, different states, all occupied states, and different states.
S1032、根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第一定位结果。S1032, according to the matching degree of each candidate positioning result, select one candidate positioning result from the candidate positioning result set as the first positioning result of the movable platform.
在确定每个候选定位结果各自对应的匹配程度之后,可移动平台根据每个候选定位结果各自对应的匹配程度,从候选定位结果集中确定可移动平台的第一定位结果,即将该匹配程度最高的候选定位结果作为可移动平台的第一定位结果。After determining the matching degree of each candidate positioning result, the movable platform determines the first positioning result of the movable platform from the candidate positioning result set according to the corresponding matching degree of each candidate positioning result, that is, the one with the highest matching degree. The candidate positioning result is used as the first positioning result of the movable platform.
上述实施例提供的高精度地图定位方法,通过候选定位结果集中的每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的栅格地图,通过离线高精度地图中的多个高度区间和每个在线栅格地图中的多个高度区间,对可移动平台进行定位,使得在一些特征稀疏或者缺乏明显特征的场景下也可以对可移动平台进行定位,能够提高高精度地图定位结果的准确性和稳定性。In the high-precision map positioning method provided by the above-mentioned embodiment, the online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set, and the raster map corresponding to each candidate positioning result is obtained. The multiple height intervals in the accuracy map and the multiple height intervals in each online raster map are used to locate the movable platform, so that the movable platform can also be located in some scenes with sparse features or lack of obvious features. It can improve the accuracy and stability of high-precision map positioning results.
请参阅图3,图3是本申请一实施例提供的另一种高精度地图定位方法的步骤示意流程图。Please refer to FIG. 3, which is a schematic flowchart of the steps of another high-precision map positioning method provided by an embodiment of the present application.
具体地,如图3所示,该高精度地图定位方法包括步骤S201至S205。Specifically, as shown in FIG. 3, the high-precision map positioning method includes steps S201 to S205.
S201、获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间。S201. Obtain an offline high-precision map, and establish an online point cloud map, where the offline high-precision map includes a plurality of first height intervals.
可移动平台在移动过程中,获取离线高精度地图,并通过激光雷达实时采集可移动平台周围物体的三维点云数据,且基于实时采集到的三维点云数据建立在线点云地图。其中,激光雷达可以基于激光发射点与发射出的激光在物体上的反射点的距离,以及激光发射点的激光的发射方向,确定物体的三维点云数据。可移动平台周边物体的三维点云数据包括物体与可移动平台的距离,物体与可移动平台的角度,以及物体的三维坐标等数据。The mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data. Among them, the lidar can determine the 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 light on the object, and the emission direction of the laser at the laser emission point. The three-dimensional point cloud data of objects around the movable platform includes 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、确定候选定位结果集,并根据所述候选定位结果集中的每个候选定 位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间。S202. Determine a candidate positioning result set, and perform rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set, to obtain an online raster map corresponding to each candidate positioning result. Wherein, the online grid map includes a plurality of second height intervals.
可移动平台确定候选定位结果集,并根据每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,即在该在线点云地图中标记该候选定位结果集中的每个候选定位结果,并对标记的每个候选定位结果周围的地图区域进行栅格化处理,可以得到每个候选定位结果各自对应的栅格地图。The mobile platform determines the candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, in the online point cloud map Mark each candidate positioning result in the candidate positioning result set, and perform rasterization processing on the map area around each marked candidate positioning result, so that a grid map corresponding to each candidate positioning result can be obtained.
S203、根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。S203. Position the movable platform according to the plurality of first height intervals in the offline high-precision map and the plurality of second height intervals in the online grid map corresponding to each candidate positioning result, to obtain all The first positioning result of the movable platform is described.
可移动平台确定每个候选定位结果各自对应的在线栅格地图之后,根据离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到可移动平台的第一定位结果。通过离线高精度地图中的多个第一高度区间和每个在线栅格地图中的多个第二高度区间,对可移动平台进行定位,可以得到准确的定位结果,能够提高高精度地图定位结果的准确性和稳定性。After the mobile platform determines the online grid map corresponding to each candidate positioning result, according to the multiple first height intervals in the offline high-precision map and the multiple second online grid maps corresponding to each candidate positioning result In the height interval, the movable platform is positioned, and the first positioning result of the movable platform is obtained. By positioning the movable platform through multiple first height intervals in the offline high-precision map and multiple second height intervals in each online raster map, accurate positioning results can be obtained, and the high-precision map positioning results can be improved Accuracy and stability.
S204、根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层对所述可移动平台进行定位,得到所述可移动平台的第二定位结果。S204: Position the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, to obtain a second positioning result of the movable platform.
可移动平台根据每个候选定位结果各自对应的在线完整高度图层和离线完整高度图层对可移动平台进行定位,得到可移动平台的第二定位结果。其中,该在线栅格地图还包括在线完整高度图层,该在线完整高度图层中每个栅格的高度为栅格内的三维点云的均值高度;该离线高精度地图还包括离线完整高度图层,该离线完整高度图层中每个栅格的高度为栅格内的三维点云的均值高度。The movable platform positions the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, and obtains the second positioning result of the movable platform. Among them, the online raster map also includes an online complete height layer, the height of each raster in the online complete height layer is the average height of the three-dimensional point cloud in the raster; the offline high-precision map also includes the offline complete height Layer, the height of each grid in this offline complete height layer is the average height of the 3D point cloud in the grid.
在一实施例中,如图4所示,步骤S204具体包括:子步骤S2041至S2042。In an embodiment, as shown in FIG. 4, step S204 specifically includes: sub-steps S2041 to S2042.
S2041、根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,确定每个候选定位结果各自对应的匹配程度。S2041, according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, determine the matching degree corresponding to each candidate positioning result.
具体地,可移动平台从离线完整高度图层中获取每个在线完整高度图层各自对应的局部离线完整高度图层;根据每个在线完整高度图层中各栅格的高度和对应的局部离线完整高度图层中各栅格的高度,确定每个在线完整高度图层与对应的局部离线完整高度图层之间的损失代价,并将每个在线完整高度图层与对应的局部离线完整高度图层之间的损失代价作为每个候选定位结果各自对 应的匹配程度。Specifically, the mobile platform obtains the corresponding partial offline complete height layer of each online complete height layer from the offline complete height layer; according to the height of each grid in each online complete height layer and the corresponding partial offline The height of each grid in the complete height layer, determine the loss cost between each online complete height layer and the corresponding partial offline complete height layer, and compare each online complete height layer with the corresponding partial offline complete height The loss cost between layers is used as the matching degree of each candidate positioning result.
S2042、根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果。S2042, according to the matching degree of each candidate positioning result, select one candidate positioning result from the candidate positioning result set as the second positioning result of the movable platform.
在确定每个候选定位结果各自对应的匹配程度之后,根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果。After determining the respective matching degree of each candidate positioning result, according to the respective matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the second positioning result of the movable platform.
其中,第二定位结果的确定方式具体为:可移动平台根据每个候选定位结果各自对应的匹配程度,对候选定位结果集中的候选定位结果进行校验;获取通过校验的每个候选定位结果各自对应的匹配程度,并将最小的匹配程度对应的通过校验的候选定位结果作为可移动平台的第二定位结果。其中,候选定位结果的校验方式具体为:确定候选定位结果的匹配程度是否小于或等于预设的匹配程度阈值,如果候选定位结果的匹配程度小于或等于预设的匹配程度阈值,则确定该候选定位结果通过校验,如果候选定位结果的匹配程度大于预设的匹配程度阈值,则确定该候选定位结果未通过校验。需要说明的是,上述匹配程度阈值可基于实际情况进行设置,本申请对此不作具体限定。将最小的匹配程度对应的通过校验的候选定位结果作为可移动平台的第二定位结果,可以进一步地提高定位结果的准确性。The method for determining the second positioning result is specifically as follows: the movable platform verifies the candidate positioning results in the candidate positioning result set according to the matching degree of each candidate positioning result; obtains each candidate positioning result that passes the verification Each corresponding degree of matching, and the candidate positioning result that passes the verification corresponding to the smallest degree of matching is used as the second positioning result of the movable platform. Among them, the verification method of the candidate positioning result is specifically: determining whether the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold; if the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold, then determining the The candidate positioning result passes the verification, and if the matching degree of the candidate positioning result is greater than the preset matching degree threshold, it is determined that the candidate positioning result fails the verification. It should be noted that the above-mentioned matching degree threshold can be set based on actual conditions, which is not specifically limited in this application. Using the candidate positioning result that has passed the verification corresponding to the smallest matching degree as the second positioning result of the movable platform can further improve the accuracy of the positioning result.
S205、对所述第一定位结果和第二定位结果进行融合,得到所述可移动平台的目标定位结果。S205. Fusion of the first positioning result and the second positioning result to obtain a target positioning result of the movable platform.
在得到可移动平台的第一定位结果和第二定位结果之后,可移动平台对第一定位结果和第二定位结果进行融合,得到可移动平台的目标定位结果。通过对两个定位结果进行融合,可以进一步地提高定位结果的准确性和稳定性。After obtaining the first positioning result and the second positioning result of the movable platform, the movable platform merges the first positioning result and the second positioning result to obtain the 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 one embodiment, the movable platform obtains the degree of matching of the first positioning result and the degree of matching 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, the degree of matching of the first positioning result is determined The first weight coefficient and the second weight coefficient of the second positioning result; the target positioning result of the movable platform is determined according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
其中,第一权重系数和第二权重系数的确定方式具体为:对第一定位结果的匹配程度和第二定位结果的匹配程度进行归一化处理;根据处理后的第一定位结果的匹配程度和处理后的第二定位结果的匹配程度,确定总匹配程度;根据处理后的第一定位结果的匹配程度和总匹配程度,确定第一定位结果的第一权重系数;根据处理后的第二定位结果的匹配程度和总匹配程度,确定第二定 位结果的第二权重系数。The method for determining the first weighting coefficient and the second weighting coefficient is specifically: normalizing the matching degree of the first positioning result and the matching degree of the second positioning result; according to the matching degree of the processed first positioning result Determine the total matching degree according to the degree of matching with the processed second positioning result; determine the first weight coefficient of the first positioning result according to the processed first positioning result’s matching degree and the total matching degree; according to the processed second The matching degree of the positioning result and the total matching degree determine the second weight coefficient of the second positioning result.
其中,权重系数的确定方式具体为:计算处理后的第一定位结果的匹配程度占总匹配程度的百分比,并将该百分比作为第一定位结果的第一权重系数;计算处理后的第二定位结果的匹配程度占总匹配程度的百分比,并将该百分比作为第二定位结果的第二权重系数。The method for determining the weight coefficient is specifically: calculating the percentage of the matching degree of the processed first positioning result to the total matching degree, and using this percentage as the first weighting coefficient of the first positioning result; calculating the processed second positioning result The matching degree of the result is the percentage of the total matching degree, and this percentage is used as the second weighting coefficient of the second positioning result.
其中,目标定位结果的确定方式具体为:计算第一定位结果与第一权重系数的乘积,得到第一权重定位结果;计算第二定位结果与第二权重系数的乘积,得到第二权重定位结果;计算第一权重定位结果与第二权重定位结果的和,并将第一权重定位结果与第二权重定位结果的和作为可移动平台的目标定位结果。The method for determining the target positioning result is specifically: calculating the product of the first positioning result and the first weight coefficient to obtain the first weighted positioning result; calculating the product of the second positioning result and the second weighting coefficient to obtain the second weighted positioning result ; Calculate the sum of the first weight positioning result and the second weight positioning result, and use the sum of the first weight positioning result and the second weight positioning result as the target positioning result of the movable platform.
上述实施例提供的高精度地图定位方法,通过候选定位结果集中的每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的栅格地图,通过离线高精度地图中的多个高度区间和每个在线栅格地图中的多个高度区间,对可移动平台进行定位,同时通过每个候选定位结果各自对应的在线完整高度图层和离线完整高度图层对可移动平台进行定位,最后通过对两个定位结果进行融合,可以进一步地提高定位结果的准确性和稳定性。In the high-precision map positioning method provided by the above-mentioned embodiment, the online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set, and the raster map corresponding to each candidate positioning result is obtained. Multiple height intervals in the accuracy map and multiple height intervals in each online raster map are used to locate the movable platform, and at the same time through each candidate positioning result corresponding online full height layer and offline full height layer Positioning the movable platform and finally fusing the two positioning results can further improve the accuracy and stability of the positioning results.
请参阅图5,图5是本申请一实施例提供的又一种高精度地图定位方法的步骤示意流程图。Please refer to FIG. 5, which is a schematic flowchart of the steps of another high-precision map positioning method according to an embodiment of the present application.
具体地,如图5所示,该高精度地图定位方法包括步骤S301至步骤S305。Specifically, as shown in FIG. 5, the high-precision map positioning method includes steps S301 to S305.
S301、获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层。S301. Obtain an offline high-precision map, and establish an online point cloud map, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer.
其中,可移动平台通过高精度的激光雷达对行驶过的区域采集三维点云数据,并通过高精度惯导系统和点云配准算法,对采集到的三维点云数据进行处理,生成离线高精度地图。Among them, the mobile platform uses high-precision lidar to collect three-dimensional point cloud data from the traveled area, and uses high-precision inertial navigation system and point cloud registration algorithm to process the collected three-dimensional point cloud data to generate offline high Accuracy map.
可移动平台在移动过程中,获取离线高精度地图,并通过激光雷达实时采集可移动平台周围物体的三维点云数据,且基于实时采集到的三维点云数据建立在线点云地图。其中,激光雷达可以基于激光发射点与发射出的激光在物体上的反射点的距离,以及激光发射点的激光的发射方向,确定物体的三维点云数据。可移动平台周边物体的三维点云数据包括物体与可移动平台的距离,物体与可移动平台的角度,以及物体的三维坐标等数据。The mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data. Among them, the lidar can determine the 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 light on the object, and the emission direction of the laser at the laser emission point. The three-dimensional point cloud data of objects around the movable platform includes 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.
其中,该离线高精度地图包括离线完整高度图层和离线非地面高度图层,该离线完整高度图层中各栅格的高度为栅格内三维点云的均值高度,该离线非地面高度图层包括多个高度区间,高度区间是按照三维点云的高度进行划分得 到的,各高度区间的高度间隔值可以相同,也可以不相同,该高度间隔值为高度区间的两端点的高度差值。需要说明的是,高度间隔值和高度区间的数量可基于实际情况进行设置,本申请对此不作具体限定。例如,高度为26米,则离线非地面高度图层中划分得到的高度区间分别为[1,5)、[5,9)、[9,14)、[14,18)、[18,22)和[22,26]共计6个第一高度区间。Among them, the offline high-precision map includes an offline complete height layer and an offline non-ground height layer. The height of each grid in the offline complete height layer is the average height of the three-dimensional point cloud in the grid. The offline non-ground height map The layer includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud. The height interval value of each height interval can be the same or different. The height interval value is the height difference between the two ends of the height interval. . It should be noted that the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application. For example, if the height is 26 meters, the height intervals divided in the offline non-ground height layer are [1, 5), [5, 9), [9, 14), [14, 18), [18, 22 ) And [22,26] total 6 first height intervals.
S302、确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层。S302. Determine a candidate positioning result set, and perform rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online raster map corresponding to each candidate positioning result. The online raster map includes an online complete height layer and an online non-ground height layer.
可移动平台确定候选定位结果集,并根据每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,即在该在线点云地图中标记该候选定位结果集中的每个候选定位结果,并对标记的每个候选定位结果周围的地图区域进行栅格化处理,可以得到每个候选定位结果各自对应的栅格地图。The mobile platform determines the candidate positioning result set, and performs rasterization processing on the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, in the online point cloud map Mark each candidate positioning result in the candidate positioning result set, and perform rasterization processing on the map area around each marked candidate positioning result, so that a grid map corresponding to each candidate positioning result can be obtained.
其中,在线栅格地图包括在线完整高度图层和在线非地面高度图层,在线完整高度图层中各栅格的高度为栅格内的三维点云的均值高度,该在线非地面高度图层包括多个高度区间,高度区间是按照三维点云的高度进行划分得到的,各高度区间的高度间隔值可以相同,也可以不相同,该高度间隔值为高度区间的两端点的高度差值。需要说明的是,高度间隔值和高度区间的数量可基于实际情况进行设置,本申请对此不作具体限定。Among them, the online raster map includes the online full height layer and the online non-ground height layer. The height of each grid in the online full height layer is the average height of the three-dimensional point cloud in the grid. This online non-ground height layer It includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud. The height interval value of each height interval may be the same or different. The height interval value is the height difference between the two end points of the height interval. It should be noted that the height interval value and the number of height intervals can be set based on actual conditions, which is not specifically limited in this application.
在一实施例中,候选定位结果集的确定方式具体为:获取可移动平台的当前位置数据和当前姿态数据;根据当前位置数据确定候选位置集;根据当前姿态数据和预设姿态误差值确定候选姿态集;根据候选位置集和所述候选姿态集,确定候选定位结果集。其中,可移动平台的当前位置数据为可移动平台的定位系统在当前时刻输出的位置数据,可移动平台的当前姿态数据为可移动平台的惯性测量单元在当前时刻输出的姿态数据。该位置数据包括可移动平台的地理位置坐标,该姿态数据包括可移动平台的俯仰角、横滚角和偏航角。In an embodiment, the method for determining the candidate positioning result set is specifically: obtaining the current position data and current attitude data of the movable platform; determining the candidate position set according to the current position data; determining the candidate position set according to the current attitude data and the preset attitude error value Pose set: Determine the candidate positioning result set according to the candidate position set and the candidate pose set. Among them, the current position data of the movable platform is the position data output by the positioning system of the movable platform at the current moment, and the current posture data of the movable platform is the posture data output by the inertial measurement unit of the movable platform at the current moment. The position data includes the geographic coordinates of the movable platform, and the attitude data includes the pitch angle, roll angle, and yaw angle of the movable platform.
在一实施例中,候选位置集的确定方式具体为:可移动平台确定当前位置数据的变化趋势,并根据当前位置数据的变化趋势,确定候选位置集。具体地,可以通过当前位置数据的梯度值和梯度方向来表征变化趋势,即以预设的单位梯度,基于该梯度值,沿着该梯度方向,得到预设个数的候选梯度值,并确定每个候选梯度值各自对应的位置信息,从而确定候选位置集。需要说明的是, 预设的单位梯度和预设个数可基于实际情况进行设置,本申请对此不作具体限定。In an embodiment, the method for determining the candidate location set is specifically as follows: the movable platform determines the change trend of the current location data, and determines the candidate location set according to the change trend of the current location data. Specifically, the change trend can be characterized by the gradient value and gradient direction of the current position data, that is, a preset unit gradient is used to obtain a preset number of candidate gradient values along the gradient direction based on the gradient value, and determine The position information corresponding to each candidate gradient value is used to determine the candidate position set. It should be noted that the preset unit gradient and the preset number can be set based on actual conditions, which is not specifically limited in this application.
在一实施例中,候选姿态集的确定方式可以为:计算当前姿态数据中的姿态角与预设姿态误差值的差值,并计算当前姿态数据中的姿态角与预设姿态误差值的和,然后基于当前姿态数据中的姿态角与预设姿态误差值的差值以及当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集,即以姿态角与预设姿态误的差值为一个端点,以姿态角与预设姿态误差值的和为另一个端点,得到候选姿态角范围,并以预设的单位姿态角从该候选姿态角范围中获取多个候选姿态角,从而形成候选姿态集。需要说明的是,上述预设姿态误差值和单位姿态角可基于实际情况进行设置,本申请对此不作具体限定。通过当前姿态数据和预设姿态误差值可以快速准确的确定候选姿态集。In an embodiment, the method for determining the candidate pose set may be: calculating the difference between the pose angle in the current pose data and the preset pose error value, and calculating the sum of the pose angle in the current pose data and the preset pose error value , And then based on the difference 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, determine the candidate attitude set, that is, the attitude angle and the preset attitude error The difference of is one end point, and the sum of the attitude angle and the preset attitude error value is the other end point to obtain the candidate attitude angle range, and obtain multiple candidate attitude angles from the candidate attitude angle range in the preset unit attitude angle , So as to form a set of candidate poses. It should be noted that the above-mentioned preset attitude error value and unit attitude angle can be set based on actual conditions, which is not specifically limited in this application. The current pose data and preset pose error values can quickly and accurately determine the candidate pose set.
S303、根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果。S303. Position the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result.
可移动平台根据每个候选定位结果各自对应的在线非地面高度图层和离线非地面高度图层,对可移动平台进行定位,得到第一定位结果。具体地,确定每个候选定位结果各自对应的在线非地面高度图层与离线非地面高度图层之间的匹配程度;根据每个候选定位结果各自对应的在线非地面高度图层与离线非地面高度图层之间的匹配程度,从候选定位结果集中确定第一定位结果,即将该匹配程度最高的候选定位结果作为可移动平台的第一定位结果。通过对每个候选定位结果各自对应的在线非地面高度图层与离线非地面高度图层进行点云匹配,并根据匹配结果,可以得到可移动平台的定位结果,提高定位结果的准确性和稳定性。The movable platform locates the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain the first positioning result. Specifically, determine the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result; according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result For the matching degree between the height layers, the first positioning result is determined from the candidate positioning result set, that is, the candidate positioning result with the highest matching degree is used as the first positioning result of the movable platform. By matching the corresponding online non-ground height layer and offline non-ground height layer of each candidate positioning result to the point cloud, and according to the matching result, the positioning result of the movable platform can be obtained, which improves the accuracy and stability of the positioning result Sex.
其中,将离线非地面高度图层中的高度区间记为第一高度区间,将在线非地面高度图层中的高度区间记为第二高度区间,第一高度区间与对应的第二高度区间相同。Among them, the height interval in the offline non-ground height layer is recorded as the first height interval, and the height interval in the online non-ground height layer is recorded as the second height interval, and the first height interval is the same as the corresponding second height interval .
在一实施例中,可移动平台确定每个在线非地面高度图层中的各第二高度区间,与离线非地面高度图层中对应的第一高度区间之间的状态比较结果;统计每个在线非地面高度图层中状态比较结果为预设状态比较结果的第二高度区间的个数;将每个在线非地面高度图层中状态比较结果为预设状态比较结果的第二高度区间的个数,作为每个候选定位结果各自对应的在线非地面高度图层与离线非地面高度图层之间的匹配程度。其中,第一高度区间和第二高度区间的状态包括占据状态和非占据状态,处于占据状态的第一高度区间或第二高度 区间中存在三维点云,而处于非占据状态的第一高度区间或第二高度区间中不存在三维点云。其中,状态比较结果包括状态不同、均为占据状态和均为非占据状态。可选地,预设状态比较结果为“均为占据状态”。In an embodiment, the movable platform determines the status comparison results between each second height interval in each online non-ground height layer and the corresponding first height interval in the offline non-ground height layer; The state comparison result in the online non-ground height layer is the number of the second height interval of the preset state comparison result; the state comparison result in each online non-ground height layer is the second height interval of the preset state comparison result The number is used as the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result. Among them, the state of the first height interval and the second height interval includes an occupied state and an unoccupied state. There is a three-dimensional point cloud in the first height interval or the second height interval in the occupied state, and the first height interval in the unoccupied state Or there is no three-dimensional point cloud in the second height interval. Among them, the state comparison results include different states, all occupied states, and all non-occupied states. Optionally, the preset state comparison result is "all occupied states".
在一实施例中,第一高度区间与对应的第二高度区间之间的状态比较结果的确定方式具体为:获取离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个在线非地面高度图层的各第二高度区间的第二状态标识信息;根据第一状态标识信息与每个第二状态标识信息,确定每个在线非地面高度图层中的各第二高度区间,与离线非地面高度图层中对应的第一高度区间之间的状态比较结果。其中,第一状态标识信息包括每个第一高度区间各自对应的状态标识符,第二状态标识信息包括每个第二高度区间各自对应的状态标识符,状态标识符以及状态标识符代表的状态可基于实际情况进行设置,本申请对此不作具体限定。可选地,状态标识符为0的高度区间处于非占据状态,状态标识符为1的高度区间处于占据状态。In an embodiment, the method for determining the state comparison result between the first height interval and the corresponding second height interval is specifically: acquiring the first state identification information of each first height interval in the offline non-ground height layer and acquiring The second state identification information of each second height interval of each online non-ground height layer; according to the first state identification information and each second state identification information, each second state identification information in each online non-ground height layer is determined The height interval is the state comparison result with the corresponding first height interval in the offline non-ground height layer. Wherein, the first state identification information includes the state identifier corresponding to each first altitude interval, and the second state identification information includes the state identifier corresponding to each second altitude interval, the state identifier, and the state represented by the state identifier. It can be set based on actual conditions, which is not specifically limited in this application. Optionally, the height interval with a state identifier of 0 is in a non-occupied state, and the height interval with a state identifier of 1 is in an occupied state.
具体地,将第一状态标识信息中每个第一高度区间各自对应的状态标识符,与第二状态标识信息中对应第二高度区间的状态标识符进行逻辑与处理,从而可以得到每个在线非地面高度图层中的各第二高度区间,与离线非地面高度图层中对应的第一高度区间之间的状态比较结果。例如,第一高度区间和第二高度区间均为7个,且第一状态标识信息为1010101,第二状态标识信息为0111101,则按位对1010101和0111101进行逻辑与处理,得到结果为0010100,则7个第二高度区间,与对应的第一高度区间之间的状态比较结果分别为状态不同、状态不同、状态不同、均为占据状态、状态不同、均为占据状态和状态不同。Specifically, the state identifier corresponding to each first altitude interval in the first state identification information is logically ANDed with the state identifier corresponding to the second altitude interval in the second state identification information, so as to obtain each online The state comparison result between each second height interval in the non-ground height layer and the corresponding first height interval in the offline non-ground height layer. For example, if the first height interval and the second height interval are both 7, and the first state identification information is 1010101, and the second state identification information is 0111101, then the logical AND processing of 1010101 and 0111101 is performed bitwise, and the result is 0010100. Then the state comparison results between the 7 second height intervals and the corresponding first height intervals are different states, different states, different states, all occupied states, different states, all occupied states, and different states.
S304、根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果。S304. Position the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result.
可移动平台根据每个候选定位结果各自对应的在线完整高度图层和离线完整高度图层对可移动平台进行定位,得到可移动平台的第二定位结果。具体地,根据每个候选定位结果各自对应的在线完整高度图层和离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;根据每个候选定位结果各自对应的匹配程度,从候选定位结果集中确定第二定位结果。The movable platform positions the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, and obtains the second positioning result of the movable platform. Specifically, according to the online complete height layer and offline complete height layer corresponding to each candidate positioning result, the corresponding matching degree of each candidate positioning result is determined; according to the matching degree of each candidate positioning result, from the candidate The positioning result centrally determines the second positioning result.
在一实施例中,可移动平台从离线完整高度图层中获取每个在线完整高度图层各自对应的局部离线完整高度图层;根据每个在线完整高度图层中各栅格的高度和对应的局部离线完整高度图层中各栅格的高度,确定每个在线完整高度图层与对应的局部离线完整高度图层之间的损失代价,并将每个在线完整高 度图层与对应的局部离线完整高度图层之间的损失代价作为每个候选定位结果各自对应的匹配程度。In one embodiment, the mobile platform obtains the local offline complete height layer corresponding to each online complete height layer from the offline complete height layer; according to the height and correspondence of each grid in each online complete height layer The height of each grid in the local offline complete height layer, determine the loss cost between each online complete height layer and the corresponding local offline complete height layer, and compare each online complete height layer with the corresponding local The loss cost between offline complete height layers is used as the matching degree of each candidate positioning result.
其中,第二定位结果的确定方式具体为:可移动平台根据每个候选定位结果各自对应的匹配程度,对候选定位结果集中的候选定位结果进行校验;获取通过校验的每个候选定位结果各自对应的匹配程度,并将最小的匹配程度对应的通过校验的候选定位结果作为可移动平台的第二定位结果。其中,候选定位结果的校验方式具体为:确定候选定位结果的匹配程度是否小于或等于预设的匹配程度阈值,如果候选定位结果的匹配程度小于或等于预设的匹配程度阈值,则确定该候选定位结果通过校验,如果候选定位结果的匹配程度大于预设的匹配程度阈值,则确定该候选定位结果未通过校验。需要说明的是,上述匹配程度阈值可基于实际情况进行设置,本申请对此不作具体限定。将最小的匹配程度对应的通过校验的候选定位结果作为可移动平台的第二定位结果,可以进一步地提高定位结果的准确性。The method for determining the second positioning result is specifically as follows: the movable platform verifies the candidate positioning results in the candidate positioning result set according to the matching degree of each candidate positioning result; obtains each candidate positioning result that passes the verification Each corresponding degree of matching, and the candidate positioning result that passes the verification corresponding to the smallest degree of matching is used as the second positioning result of the movable platform. Among them, the verification method of the candidate positioning result is specifically: determining whether the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold; if the matching degree of the candidate positioning result is less than or equal to the preset matching degree threshold, then determining the The candidate positioning result passes the verification, and if the matching degree of the candidate positioning result is greater than the preset matching degree threshold, it is determined that the candidate positioning result fails the verification. It should be noted that the above-mentioned matching degree threshold can be set based on actual conditions, which is not specifically limited in this application. Using the candidate positioning result that has passed the verification corresponding to the smallest matching degree as the second positioning result of the movable platform can further improve the accuracy of the positioning result.
S305、根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。S305. Determine a target positioning result of the movable platform according to the first positioning result and the second positioning result.
在确定可移动平台的第一定位结果和第二定位结果之后,根据第一定位结果和第二定位结果,确定可移动平台的目标定位结果。通过对两个定位结果进行融合,可以进一步地提高定位结果的准确性和稳定性。After determining the first positioning result and the second positioning result of the movable platform, the target positioning result of the movable platform is determined 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 one embodiment, the movable platform obtains the degree of matching of the first positioning result and the degree of matching 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, the degree of matching of the first positioning result is determined The first weight coefficient and the second weight coefficient of the second positioning result; the target positioning result of the movable platform is determined according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
其中,第一权重系数和第二权重系数的确定方式具体为:对第一定位结果的匹配程度和第二定位结果的匹配程度进行归一化处理;根据处理后的第一定位结果的匹配程度和处理后的第二定位结果的匹配程度,确定总匹配程度;根据处理后的第一定位结果的匹配程度和总匹配程度,确定第一定位结果的第一权重系数;根据处理后的第二定位结果的匹配程度和总匹配程度,确定第二定位结果的第二权重系数。The method for determining the first weighting coefficient and the second weighting coefficient is specifically: normalizing the matching degree of the first positioning result and the matching degree of the second positioning result; according to the matching degree of the processed first positioning result Determine the total matching degree according to the degree of matching with the processed second positioning result; determine the first weight coefficient of the first positioning result according to the processed first positioning result’s matching degree and the total matching degree; according to the processed second The matching degree of the positioning result and the total matching degree determine the second weight coefficient of the second positioning result.
其中,权重系数的确定方式具体为:计算处理后的第一定位结果的匹配程度占总匹配程度的百分比,并将该百分比作为第一定位结果的第一权重系数;计算处理后的第二定位结果的匹配程度占总匹配程度的百分比,并将该百分比 作为第二定位结果的第二权重系数。The method for determining the weight coefficient is specifically: calculating the percentage of the matching degree of the processed first positioning result to the total matching degree, and using this percentage as the first weighting coefficient of the first positioning result; calculating the processed second positioning result The matching degree of the result is the percentage of the total matching degree, and this percentage is used as the second weighting coefficient of the second positioning result.
其中,目标定位结果的确定方式具体为:计算第一定位结果与第一权重系数的乘积,得到第一权重定位结果;计算第二定位结果与第二权重系数的乘积,得到第二权重定位结果;计算第一权重定位结果与第二权重定位结果的和,并将第一权重定位结果与第二权重定位结果的和作为可移动平台的目标定位结果。The method for determining the target positioning result is specifically: calculating the product of the first positioning result and the first weight coefficient to obtain the first weighted positioning result; calculating the product of the second positioning result and the second weighting coefficient to obtain the second weighted positioning result ; Calculate the sum of the first weight positioning result and the second weight positioning result, and use the sum of the first weight positioning result and the second weight positioning result as the target positioning result of the movable platform.
上述实施例提供的高精度地图定位方法,通过候选定位结果集中的每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的栅格地图,通过离线非地面高度图层和每个栅格地图中的在线非地面高度图层,对可移动平台进行定位,得到一个定位结果,同时通过离线完整高度图层和每个栅格地图中的在线完整高度图层,对可移动平台进行定位,得到另一个定位结果,最后通过这两个定位结果共同确定可移动平台最终的定位结果,使得在一些特征稀疏或者缺乏明显特征的场景下也可以对可移动平台进行定位,能够提高高精度地图定位结果的准确性和稳定性。In the high-precision map positioning method provided by the above-mentioned embodiment, the online point cloud map is rasterized through each candidate positioning result in the candidate positioning result set, and the raster map corresponding to each candidate positioning result is obtained. The ground height layer and the online non-ground height layer in each raster map are used to locate the movable platform to obtain a positioning result. At the same time, through the offline complete height layer and the online complete height map in each raster map Layer, the movable platform is positioned, and another positioning result is obtained. Finally, the final positioning result of the movable platform is jointly determined by the two positioning results, so that the movable platform can also be tested in some scenes with sparse features or lack of obvious features. Positioning can improve the accuracy and stability of high-precision map positioning results.
请参阅图6,图6是本申请一实施例提供的又一种高精度地图定位方法的步骤示意流程图。Please refer to FIG. 6, which is a schematic flowchart of the steps of yet another high-precision map positioning method according to an embodiment of the present application.
具体地,如图6所示,该高精度地图定位方法包括步骤S401至步骤S407。Specifically, as shown in FIG. 6, the high-precision map positioning method includes steps S401 to S407.
S401、获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层。S401. Obtain an offline high-precision map, and establish an online point cloud map, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer.
其中,可移动平台通过高精度的激光雷达对行驶过的区域采集三维点云数据,并通过高精度惯导系统和点云配准算法,对采集到的三维点云数据进行处理,生成离线高精度地图。Among them, the mobile platform uses high-precision lidar to collect three-dimensional point cloud data from the traveled area, and uses high-precision inertial navigation system and point cloud registration algorithm to process the collected three-dimensional point cloud data to generate offline high Accuracy map.
可移动平台在移动过程中,获取离线高精度地图,并通过激光雷达实时采集可移动平台周围物体的三维点云数据,且基于实时采集到的三维点云数据建立在线点云地图。The mobile platform acquires offline high-precision maps during the movement process, collects real-time 3D point cloud data of objects around the mobile platform through lidar, and establishes an online point cloud map based on the real-time collected 3D point cloud data.
其中,该离线高精度地图包括离线完整高度图层和离线非地面高度图层,该离线完整高度图层中各栅格的高度为栅格内三维点云的均值高度,该离线非地面高度图层包括多个高度区间,高度区间是按照三维点云的高度进行划分得到的,各高度区间的高度间隔值可以相同,也可以不相同,该高度间隔值为高度区间的两端点的高度差值。Among them, the offline high-precision map includes an offline complete height layer and an offline non-ground height layer. The height of each grid in the offline complete height layer is the average height of the three-dimensional point cloud in the grid. The offline non-ground height map The layer includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud. The height interval value of each height interval can be the same or different. The height interval value is the height difference between the two ends of the height interval. .
S402、获取可移动平台的历史定位结果,所述历史定位结果为所述可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间。S402. Obtain a historical positioning result of the movable platform, where the historical positioning result is a positioning result determined by the movable platform at a previous time, and the previous time is separated from the current time by a preset time.
具体地,获取可移动平台的历史定位结果,该历史定位结果为可移动平台 在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间。需要说明的是,上述预设时间可基于实际情况进行设置,本申请对此不作具体限定。Specifically, the historical positioning result of the movable platform is acquired, and the historical positioning result is the positioning result determined by the movable platform at the previous time, and the previous time and the current time are separated by a preset time. It should be noted that the aforementioned preset time can be set based on actual conditions, which is not specifically limited in this application.
S403、根据所述历史定位结果确定候选定位结果集。S403: Determine a candidate positioning result set according to the historical positioning result.
具体地,从该历史定位结果中获取历史位置坐标和历史姿态角;对历史位置坐标进行求导处理,以确定历史位置坐标的梯度值和梯度方向,并根据该梯度值和梯度方向,确定候选位置集,即以预设的单位梯度,基于该梯度值,沿着该梯度方向,得到预设个数的候选梯度值,并确定每个候选梯度值各自对应的位置信息,从而确定候选位置集;Specifically, obtain the historical position coordinates and historical attitude angle from the historical positioning results; perform derivative processing on the historical position coordinates to determine the gradient value and the gradient direction of the historical position coordinates, and determine the candidate according to the gradient value and the gradient direction Position set, that is, a preset number of candidate gradient values are obtained along the gradient direction based on the gradient value based on the preset unit gradient, and the position information corresponding to each candidate gradient value is determined, thereby determining the candidate position set ;
计算历史姿态角与预设姿态误差值的差值,并计算历史姿态角与预设姿态误差值的和;以历史姿态角与预设姿态误差值的差值为一个端点,以历史姿态角与预设姿态误差值的和为另一个端点,得到候选姿态角范围,并以预设的单位姿态角从该候选姿态角范围中获取多个候选姿态角,从而形成候选姿态集;Calculate the difference between the historical attitude angle and the preset attitude error value, and calculate the sum of the historical attitude angle and the preset attitude error value; take the difference between the historical attitude angle and the preset attitude error value as an endpoint, and use the historical attitude angle and The sum of the preset attitude error values is the other end point to obtain the candidate attitude angle range, and obtain multiple candidate attitude angles from the candidate attitude angle range in the preset unit attitude angle, thereby forming a candidate pose set;
根据该候选位置集和候选姿态集,确定候选定位结果集,即每次从候选位置集选择一个候选位置与候选姿态集中的每个候选姿态进行组合,直至候选位置集中的候选位置均被选择一次时,汇集组合得到的每个候选定位结果作为候选定位结果集。According to the candidate position set and the candidate pose set, determine the candidate positioning result set, that is, each candidate position is selected from the candidate position set and combined with each candidate pose in the candidate pose set until the candidate positions in the candidate position set are selected once At this time, each candidate positioning result obtained by the collection and combination is used as a candidate positioning result set.
需要说明的是,上述预设的单位梯度、预设个数、预设姿态误差值和预设的单位姿态角可基于实际情况进行设置,本申请对此不作具体限定。It should be noted that the aforementioned preset unit gradient, preset number, preset attitude error value, and preset unit attitude angle can be set based on actual conditions, and this application does not specifically limit this.
在一实施例中,候选定位结果集的确定方式可以为:从该历史定位结果中获取历史位置坐标和历史姿态角,并计算历史位置坐标和历史姿态角分别与预设定位误差值的差,且计算历史位置坐标和历史姿态角分别与预设定位误差值的和,然后基于历史位置坐标与预设定位误差值的差以及和,确定候选坐标集,并基于历史姿态角与预设定位误差值的差以及和,确定候选姿态集,最后基于候选坐标集和候选姿态集,确定候选定位结果集。需要说明的是,上述预设定位误差值可基于实际情况进行设置,本申请对此不作具体限定。In an embodiment, the method for determining the candidate positioning result set may be: obtaining historical position coordinates and historical attitude angles from the historical positioning results, and calculating the differences between the historical position coordinates and historical attitude angles and the preset positioning error values. And calculate the sum of the historical position coordinates and the historical attitude angle respectively with the preset positioning error value, and then determine the candidate coordinate set based on the difference and the sum of the historical position coordinates and the preset positioning error value, and based on the historical attitude angle and the preset positioning error The difference and the sum of the values determine the candidate pose set, and finally based on the candidate coordinate set and the candidate pose set, determine the candidate positioning result set. It should be noted that the above-mentioned preset positioning error value can be set based on actual conditions, which is not specifically limited in this application.
S404、根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层。S404. Perform rasterization processing on the online point cloud map according to each candidate positioning result in the candidate positioning result set to obtain an online raster map corresponding to each candidate positioning result, where the online raster map includes Online full height layer and online non-ground height layer.
可移动平台根据每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,即在该在线点云地图中标记该候选定位结果集中的每个候选定位结果,并对标记的每个候选定位结果周围的 地图区域进行栅格化处理,可以得到每个候选定位结果各自对应的栅格地图。The mobile platform rasterizes the online point cloud map according to each candidate positioning result, and obtains the online grid map corresponding to each candidate positioning result, that is, mark the candidate positioning result set in the online point cloud map For each candidate positioning result, rasterize the map area around each marked candidate positioning result to obtain a grid map corresponding to each candidate positioning result.
其中,在线栅格地图包括在线完整高度图层和在线非地面高度图层,在线完整高度图层中各栅格的高度为栅格内的三维点云的均值高度,该在线非地面高度图层包括多个高度区间,高度区间是按照三维点云的高度进行划分得到的,各高度区间的高度间隔值可以相同,也可以不相同,该高度间隔值为高度区间的两端点的高度差值。Among them, the online raster map includes the online full height layer and the online non-ground height layer. The height of each grid in the online full height layer is the average height of the three-dimensional point cloud in the grid. This online non-ground height layer It includes multiple height intervals, which are divided according to the height of the three-dimensional point cloud. The height interval value of each height interval may be the same or different. The height interval value is the height difference between the two end points of the height interval.
S405、根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果。S405. Position the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result.
可移动平台确定每个候选定位结果各自对应的在线栅格地图之后,根据离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到可移动平台的第一定位结果。通过离线高精度地图中的多个第一高度区间和每个在线栅格地图中的多个第二高度区间,对可移动平台进行定位,可以得到准确的定位结果,能够提高高精度地图定位结果的准确性和稳定性。After the mobile platform determines the online grid map corresponding to each candidate positioning result, according to the multiple first height intervals in the offline high-precision map and the multiple second online grid maps corresponding to each candidate positioning result In the height interval, the movable platform is positioned, and the first positioning result of the movable platform is obtained. By positioning the movable platform through multiple first height intervals in the offline high-precision map and multiple second height intervals in each online raster map, accurate positioning results can be obtained, and the high-precision map positioning results can be improved Accuracy and stability.
S406、根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果。S406: Position the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result.
可移动平台根据每个候选定位结果各自对应的在线完整高度图层和离线完整高度图层对可移动平台进行定位,得到可移动平台的第二定位结果。具体地,根据每个候选定位结果各自对应的在线完整高度图层和离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;根据每个候选定位结果各自对应的匹配程度,从候选定位结果集中确定第二定位结果。The movable platform positions the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, and obtains the second positioning result of the movable platform. Specifically, according to the online complete height layer and offline complete height layer corresponding to each candidate positioning result, the corresponding matching degree of each candidate positioning result is determined; according to the matching degree of each candidate positioning result, from the candidate The positioning result centrally determines the second positioning result.
S407、根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。S407: Determine a target positioning result of the movable platform according to the first positioning result and the second positioning result.
在确定可移动平台的第一定位结果和第二定位结果之后,根据第一定位结果和第二定位结果,确定可移动平台的目标定位结果。通过对两个定位结果进行融合,可以进一步地提高定位结果的准确性和稳定性。After determining the first positioning result and the second positioning result of the movable platform, the target positioning result of the movable platform is determined 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 one embodiment, the movable platform obtains the degree of matching of the first positioning result and the degree of matching 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, the degree of matching of the first positioning result is determined The first weight coefficient and the second weight coefficient of the second positioning result; the target positioning result of the movable platform is determined according to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient.
上述实施例提供的高精度地图定位方法,通过历史定位结果和定位误差值, 可以准确的确定候选定位结果集,并基于准确的候选定位结果集中的每个候选定位结果,对在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的栅格地图,通过离线非地面高度图层和每个栅格地图中的在线非地面高度图层,对可移动平台进行定位,得到一个定位结果,同时通过离线完整高度图层和每个栅格地图中的在线完整高度图层,对可移动平台进行定位,得到另一个定位结果,最后通过这两个定位结果共同确定可移动平台最终的定位结果,使得在一些特征稀疏或者缺乏明显特征的场景下也可以对可移动平台进行定位,能够提高高精度地图定位结果的准确性和稳定性。The high-precision map positioning method provided in the foregoing embodiment can accurately determine the candidate positioning result set through historical positioning results and positioning error values, and perform an online point cloud map based on each candidate positioning result in the accurate candidate positioning result set. Rasterization process, get the raster map corresponding to each candidate positioning result, use the offline non-ground height layer and the online non-ground height layer in each raster map to locate the movable platform to obtain a positioning As a result, the mobile platform is positioned through the offline complete height layer and the online complete height layer in each raster map at the same time, and another positioning result is obtained. Finally, the final position of the movable platform is determined by the two positioning results. The positioning result makes it possible to locate the movable platform in some scenes with sparse features or lack of obvious features, which can improve the accuracy and stability of the high-precision map positioning result.
请参阅图7,图7是本申请一实施例提供的驾驶系统的示意性框图。在一种实施方式中,该驾驶系统包括无人驾驶系统和有人驾驶系统。进一步地,该驾驶系统500包括处理器501、存储器502和激光雷达503,处理器501、存储器502和激光雷达503通过总线504连接,该总线504比如为I2C(Inter-integrated Circuit)总线。Please refer to FIG. 7, which is a schematic block diagram of a driving system provided by an embodiment of the present application. In one embodiment, the driving system includes an unmanned driving system and a manned driving system. Further, the driving system 500 includes a processor 501, a memory 502, and a lidar 503. The processor 501, the memory 502, and the lidar 503 are connected by a bus 504, such as an I2C (Inter-integrated Circuit) bus.
具体地,处理器501可以是微控制单元(Micro-controller Unit,MCU)、中央处理单元(Central Processing Unit,CPU)或数字信号处理器(Digital Signal Processor,DSP)等。Specifically, the processor 501 may be a micro-controller unit (MCU), a central processing unit (CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
具体地,存储器502可以是Flash芯片、只读存储器(ROM,Read-Only Memory)磁盘、光盘、U盘或移动硬盘等。Specifically, the memory 502 may be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk, or a mobile hard disk.
具体地,处理器501和存储器502为驾驶系统的计算平台,该激光雷达303可以为驾驶系统的外接设备,也可以为驾驶系统的内部组件,本申请对此不作具体限定。Specifically, the processor 501 and the memory 502 are the computing platform 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 specifically limited in this application.
其中,所述处理器501用于运行存储在存储器502中的计算机程序,并在执行所述计算机程序时实现如上所述的高精度地图定位方法的步骤。Wherein, the processor 501 is configured to run a computer program stored in the memory 502, and implement the steps of the high-precision map positioning method as described above when the computer program is executed.
需要说明的是,所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的驾驶系统的具体工作过程,可以参考前述高精度地图定位方法实施例中的对应过程,在此不再赘述。It should be noted that those skilled in the art can clearly understand that for the convenience and brevity of the description, the specific working process of the driving system described above can refer to the corresponding process in the above-mentioned high-precision map positioning method embodiment. No longer.
请参阅图8,图8是本申请一实施例提供的可移动平台的示意性框图。该可移动平台800包括处理器601、存储器602和激光雷达603,处理器801、存储器602和激光雷达603通过总线604连接,该总线604比如为I2C(Inter-integrated Circuit)总线。其中,可移动平台包括车辆和飞行器,飞行器包括无人飞行器和有人飞行器,车辆包括有人驾驶车辆和无人驾驶车辆等,无人飞行器包括旋翼型无人飞行器,例如四旋翼无人飞行器、六旋翼无人飞行器、 八旋翼无人飞行器,也可以是固定翼无人飞行器,还可以是旋翼型与固定翼无人飞行器的组合,在此不作限定。Please refer to FIG. 8, which is a schematic block diagram of a movable platform provided by an embodiment of the present application. The mobile platform 800 includes a processor 601, a memory 602, and a lidar 603. The processor 801, the memory 602, and the lidar 603 are connected by a bus 604, which is, for example, an I2C (Inter-integrated Circuit) bus. Among them, movable platforms include vehicles and aircraft, aircraft include unmanned aerial vehicles and manned aerial vehicles, vehicles include manned vehicles and unmanned vehicles, etc. Unmanned aerial vehicles include rotary-wing unmanned aerial vehicles, such as four-rotor unmanned aerial vehicles and hexarotors. An unmanned aerial vehicle, an eight-rotor unmanned aerial vehicle, or a fixed-wing unmanned aerial vehicle, or a combination of a rotor-type and a fixed-wing unmanned aerial vehicle, is not limited here.
具体地,处理器601可以是微控制单元(Micro-controller Unit,MCU)、中央处理单元(Central Processing Unit,CPU)或数字信号处理器(Digital Signal Processor,DSP)等。Specifically, the processor 601 may be a micro-controller unit (MCU), a central processing unit (CPU), a digital signal processor (Digital Signal Processor, DSP), or the like.
具体地,存储器602可以是Flash芯片、只读存储器(ROM,Read-Only Memory)磁盘、光盘、U盘或移动硬盘等。Specifically, the memory 602 may be a Flash chip, a read-only memory (ROM, Read-Only Memory) disk, an optical disk, a U disk, or a mobile hard disk.
具体地,处理器601和存储器602为驾驶系统的计算平台,该激光雷达603可以为驾驶系统的外接设备,也可以为驾驶系统的内部组件,本申请对此不作具体限定。Specifically, the processor 601 and the memory 602 are the computing platform 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 specifically limited in this application.
其中,所述处理器601用于运行存储在存储器602中的计算机程序,并在执行所述计算机程序时实现如上所述的高精度地图定位方法的步骤。Wherein, the processor 601 is configured to run a computer program stored in the memory 602, and implement the steps of the high-precision map positioning method as described above when the computer program is executed.
需要说明的是,所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的可移动平台的具体工作过程,可以参考前述高精度地图定位方法实施例中的对应过程,在此不再赘述。It should be noted that those skilled in the art can clearly understand that for the convenience and conciseness of description, the specific working process of the mobile platform described above can refer to the corresponding process in the above-mentioned high-precision map positioning method embodiment. This will not be repeated here.
本申请的实施例中还提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序中包括程序指令,所述处理器执行所述程序指令,实现上述实施例提供的高精度地图定位方法的步骤。The embodiments of the present application also provide a computer-readable storage medium, the computer-readable storage medium stores a computer program, the computer program includes program instructions, and the processor executes the program instructions to implement the foregoing implementation The steps of the high-precision map positioning method provided in the example.
其中,所述计算机可读存储介质可以是前述任一实施例所述的驾驶系统或可移动平台的内部存储单元,例如所述驾驶系统或可移动平台的硬盘或内存。所述计算机可读存储介质也可以是所述驾驶系统或可移动平台的外部存储设备,例如所述驾驶系统或可移动平台上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。The computer-readable storage medium may be the internal storage unit of the driving system or the movable platform described in any of the foregoing embodiments, for example, the hard disk or memory of the driving system or the movable platform. The computer-readable storage medium may also be an external storage device of the driving system or a removable platform, for example, a plug-in hard disk or a smart memory card (Smart Media Card, SMC) equipped on the driving system or the removable platform. , Secure Digital (SD) card, Flash Card (Flash Card), etc.
应当理解,在此本申请说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本申请。如在本申请说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。It should be understood that the terms used in the specification of this application are only for the purpose of describing specific embodiments and are not intended to limit the application. As used in the specification of this application and the appended claims, unless the context clearly indicates other circumstances, the singular forms "a", "an" and "the" are intended to include plural forms.
还应当理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。It should also be understood that the term "and/or" used in the specification and appended claims of this application refers to any combination of one or more of the associated listed items and all possible combinations, and includes these combinations.
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到 各种等效的修改或替换,这些修改或替换都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以权利要求的保护范围为准。The above are only specific implementations of this application, but the protection scope of this application is not limited to this. Anyone familiar with the technical field can easily think of various equivalents within the technical scope disclosed in this application. Modifications or replacements, these modifications or replacements shall be covered within the scope of protection of this application. Therefore, the protection scope of this application should be subject to the protection scope of the claims.

Claims (76)

  1. 一种高精度地图定位方法,其特征在于,包括:A high-precision map positioning method is characterized in that it includes:
    获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间;Acquiring an offline high-precision map and establishing an online point cloud map, where the offline high-precision map includes a plurality of first height intervals;
    确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间;Determine the candidate positioning result set, and perform 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 includes a plurality of second height intervals;
    根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。According to the plurality of first height intervals in the offline high-precision map and the plurality of second height intervals in the online grid map corresponding to each candidate positioning result, the movable platform is positioned to obtain the The first positioning result of the mobile platform.
  2. 根据权利要求1所述的高精度地图定位方法,其特征在于,所述根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果,包括:The high-precision map positioning method according to claim 1, wherein the online grid map corresponding to each candidate positioning result according to the multiple first height intervals in the offline high-precision map Positioning the movable platform in a plurality of second height intervals to obtain the first positioning result of the movable platform includes:
    根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,确定每个候选定位结果各自对应的匹配程度;According to the multiple first height intervals in the offline high-precision map and the multiple second height intervals in the online grid map corresponding to each candidate positioning result, the matching degree corresponding to each candidate positioning result is determined ;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第一定位结果。According to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the first positioning result of the movable platform.
  3. 根据权利要求2所述的高精度地图定位方法,其特征在于,所述离线高精度地图包括离线非地面高度层,所述多个第一高度区间位于所述离线非地面高度层,所述在线栅格地图包括在线非地面高度层,所述多个第二高度区间位于所述在线非地面高度层;所述根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,确定每个候选定位结果各自对应的匹配程度,包括:The high-precision map positioning method according to claim 2, wherein the offline high-precision map comprises an offline non-ground height layer, the plurality of first height intervals are located in the offline non-ground height layer, and the online The grid map includes an online non-ground height layer, and the plurality of second height intervals are located in the online non-ground height layer; according to the plurality of first height intervals in the offline high-precision map and each candidate positioning result The respective corresponding multiple second height intervals in the online grid map determine the matching degree corresponding to each candidate positioning result, including:
    确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果;Determining a state comparison result between each of the second height intervals in each of the online non-ground height layers and the corresponding first height intervals in the offline non-ground height layers;
    统计每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数;Counting the number of the second height intervals in each of the online non-ground height layers where the state comparison result is a preset state comparison result;
    根据每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数,确定每个候选定位结果各自对应的匹配程度。According to the number of the second height intervals in each of the online non-ground height layers where the state comparison result is the preset state comparison result, the matching degree corresponding to each candidate positioning result is determined.
  4. 根据权利要求3所述的高精度地图定位方法,其特征在于,所述确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果,包括:The high-precision map positioning method according to claim 3, wherein the determining each of the second height intervals in each of the online non-ground height layers is different from that in the offline non-ground height layers The corresponding state comparison results between the first height intervals include:
    获取所述离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个所述在线非地面高度图层的各第二高度区间的第二状态标识信息;Acquiring first state identification information of each first height interval in the offline non-ground height layer and acquiring second state identification information of each second height interval in each of the online non-ground height layer;
    根据所述第一状态标识信息与每个所述第二状态标识信息,确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果。According to the first state identification information and each of the second state identification information, it is determined that each of the second height intervals in each of the online non-ground height layers is different from that in the offline non-ground height layer. The state comparison result between the corresponding first height intervals.
  5. 根据权利要求1至4中任一项所述的高精度地图定位方法,其特征在于,所述在线栅格地图还包括在线完整高度图层,所述离线高精度地图还包括离线完整高度图层;所述根据所述离线高精度地图中的多个第一高度区间和每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果之后,还包括:The high-precision map positioning method according to any one of claims 1 to 4, wherein the online raster map further includes an online complete height layer, and the offline high-precision map further includes an offline complete height layer The positioning of the movable platform is performed according to the plurality of first height intervals in the offline high-precision map and the plurality of second height intervals in the online grid map corresponding to each candidate positioning result, to obtain After the first positioning result of the movable platform, it further includes:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层对所述可移动平台进行定位,得到所述可移动平台的第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, to obtain a second positioning result of the movable platform;
    对所述第一定位结果和第二定位结果进行融合,得到所述可移动平台的目标定位结果。The first positioning result and the second positioning result are merged to obtain the target positioning result of the movable platform.
  6. 根据权利要求5所述的高精度地图定位方法,其特征在于,所述根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层对所述可移动平台进行定位,得到所述可移动平台的第二定位结果,包括:The high-precision map positioning method according to claim 5, wherein the online complete height layer and the offline complete height layer corresponding to each candidate positioning result are performed on the movable platform Positioning to obtain the second positioning result of the movable platform includes:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;Determine the matching degree corresponding to each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果。According to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the second positioning result of the movable platform.
  7. 根据权利要求6所述的高精度地图定位方法,其特征在于,所述根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果,包括:The high-precision map positioning method according to claim 6, characterized in that, according to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the mobile platform The second positioning results include:
    根据每个候选定位结果各自对应的匹配程度,对所述候选定位结果集中的候选定位结果进行校验;Verifying the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
    获取通过校验的每个所述候选定位结果各自对应的匹配程度,并将最小的所述匹配程度对应的通过校验的所述候选定位结果作为所述可移动平台的第二定位结果。A matching degree corresponding to each candidate positioning result that has passed the verification is acquired, and the candidate positioning result that has passed the verification corresponding to the smallest matching degree is taken as the second positioning result of the movable platform.
  8. 根据权利要求5所述的高精度地图定位方法,其特征在于,所述对所述第一定位结果和第二定位结果进行融合,得到所述可移动平台的目标定位结果,包括:The high-precision map positioning method according to claim 5, wherein the fusing the first positioning result and the second positioning result to obtain the target positioning result of the movable platform comprises:
    获取所述第一定位结果的匹配程度以及获取所述第二定位结果的匹配程度;Acquiring the matching degree of the first positioning result and acquiring the matching degree of the second positioning result;
    根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数;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;
    根据所述第一定位结果、第二定位结果、第一权重系数和第二权重系数,确定所述可移动平台的目标定位结果。According to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient, the target positioning result of the movable platform is determined.
  9. 根据权利要求8所述的高精度地图定位方法,其特征在于,所述根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数,包括:The high-precision map positioning method according to claim 8, wherein the first positioning result of the first positioning result is determined according to the matching degree of the first positioning result and the matching degree of the second positioning result. The weight coefficient and the second weight coefficient of the second positioning result include:
    对所述第一定位结果的匹配程度和所述第二定位结果的匹配程度进行归一化处理;Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
    根据处理后的所述第一定位结果的匹配程度和处理后的所述第二定位结果的匹配程度,确定总匹配程度;Determine the overall matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
    根据处理后的所述第一定位结果的匹配程度和所述总匹配程度,确定所述第一定位结果的第一权重系数;Determining the first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
    根据处理后的所述第二定位结果的匹配程度和所述总匹配程度,确定所述第二定位结果的第二权重系数。The second weight coefficient of the second positioning result is determined according to the matching degree of the second positioning result after processing and the total matching degree.
  10. 根据权利要求1至4中任一项所述的高精度地图定位方法,其特征在于,所述确定候选定位结果集,包括:The high-precision map positioning method according to any one of claims 1 to 4, wherein the determining a candidate positioning result set comprises:
    获取可移动平台的当前位置数据和当前姿态数据;Obtain the current position data and current posture data of the movable platform;
    根据所述当前位置数据确定候选位置集;Determining a candidate position set according to the current position data;
    根据所述当前姿态数据和预设姿态误差值确定候选姿态集;Determining a candidate pose set according to the current pose data and a preset pose error value;
    根据所述候选位置集和所述候选姿态集,确定候选定位结果集。According to the candidate position set and the candidate pose set, a candidate positioning result set is determined.
  11. 根据权利要求10所述的高精度地图定位方法,其特征在于,所述根据所述当前位置数据确定候选位置集,包括:The high-precision map positioning method according to claim 10, wherein the determining a candidate position set according to the current position data comprises:
    确定所述当前位置数据的变化趋势,并根据所述当前位置数据的变化趋势,确定候选位置集。The change trend of the current position data is determined, and a candidate position set is determined according to the change trend of the current position data.
  12. 根据权利要求10所述的高精度地图定位方法,其特征在于,所述根据所述当前姿态数据和预设姿态误差值确定候选姿态集,包括:The high-precision map positioning method according to claim 10, wherein the determining a candidate pose set according to the current pose data and a preset pose error value comprises:
    计算所述当前姿态数据中的姿态角与预设姿态误差值的差值,以及计算所 述当前姿态数据中的姿态角与预设姿态误差值的和;Calculating the difference between the attitude angle in the current attitude data and the preset attitude error value, and calculating the sum of the attitude angle in the current attitude data and the preset attitude error value;
    根据所述当前姿态数据中的姿态角与预设姿态误差值的差值以及所述当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集。The candidate pose set is determined according to the difference 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.
  13. 根据权利要求1至4中任一项所述的高精度地图定位方法,其特征在于,所述确定候选定位结果集,包括:The high-precision map positioning method according to any one of claims 1 to 4, wherein the determining a candidate positioning result set comprises:
    获取可移动平台的历史定位结果,所述历史定位结果为所述可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间;Acquiring a historical positioning result of the movable platform, where the historical positioning result is a positioning result determined by the movable platform at a previous time, and the previous time and the current time are separated by a preset time;
    根据所述历史定位结果确定候选定位结果集。A candidate positioning result set is determined according to the historical positioning result.
  14. 一种高精度地图定位方法,其特征在于,包括:A high-precision map positioning method is characterized in that it includes:
    获取离线高精度地图,并建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层;Obtain an offline high-precision map, and establish an online point cloud map, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer;
    确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层;Determine the candidate positioning result set, and perform 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. Online raster map includes online complete height layer and online non-ground height layer;
    根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果;以及Positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result; and
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result;
    根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。According to the first positioning result and the second positioning result, the target positioning result of the movable platform is determined.
  15. 根据权利要求14所述的高精度地图定位方法,其特征在于,所述根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果,包括:The high-precision map positioning method according to claim 14, wherein the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result are compared to the The mobile platform performs positioning and obtains the first positioning result, including:
    确定每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度;Determining the degree of matching between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度,从所述候选定位结果集中确定第一定位结果。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, a first positioning result is determined from the candidate positioning result set.
  16. 根据权利要求15所述的高精度地图定位方法,其特征在于,所述离线非地面高度图层包括多个第一高度区间,所述在线非地面高度图层包括多个第二高度区间,所述第一高度区间与对应的第二高度区间相同;所述确定每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度,包括:The high-precision map positioning method according to claim 15, wherein the offline non-ground height layer includes a plurality of first height intervals, and the online non-ground height layer includes a plurality of second height intervals, so The first height interval is the same as the corresponding second height interval; the determining the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result includes:
    确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果;Determining a state comparison result between each of the second height intervals in each of the online non-ground height layers and the corresponding first height intervals in the offline non-ground height layers;
    统计每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数;Counting the number of the second height intervals in each of the online non-ground height layers where the state comparison result is a preset state comparison result;
    将每个所述个数,作为每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度。Use each of the numbers as the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result.
  17. 根据权利要求16所述的高精度地图定位方法,其特征在于,所述确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果,包括:The high-precision map positioning method according to claim 16, wherein the determining each of the second height intervals in each of the online non-ground height layers differs from those in the offline non-ground height layers The corresponding state comparison results between the first height intervals include:
    获取所述离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个所述在线非地面高度图层的各第二高度区间的第二状态标识信息;Acquiring first state identification information of each first height interval in the offline non-ground height layer and acquiring second state identification information of each second height interval in each of the online non-ground height layer;
    根据每个所述第二状态标识信息与所述第一状态标识信息,确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果。According to each of the second state identification information and the first state identification information, it is determined that each of the second height intervals in each of the online non-ground height layers is different from that in the offline non-ground height layers. The state comparison result between the corresponding first height intervals.
  18. 根据权利要求14所述的高精度地图定位方法,其特征在于,所述根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果,包括:The high-precision map positioning method according to claim 14, wherein the mobile platform is positioned according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result To get the second positioning result, including:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;Determine the matching degree corresponding to each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中确定第二定位结果。According to the matching degree of each candidate positioning result, the second positioning result is determined from the candidate positioning result set.
  19. 根据权利要求18所述的高精度地图定位方法,其特征在于,所述根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中确定第二定位结果,包括:The high-precision map positioning method according to claim 18, wherein the determining the second positioning result from the candidate positioning result set according to the corresponding matching degree of each candidate positioning result comprises:
    根据每个候选定位结果各自对应的匹配程度,对所述候选定位结果集中的候选定位结果进行校验;Verifying the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
    获取通过校验的每个候选定位结果各自对应的匹配程度,并将最小的所述匹配程度对应的通过校验的候选定位结果作为第二定位结果。The matching degree corresponding to each candidate positioning result that passed the verification is acquired, and the candidate positioning result that passes the verification corresponding to the smallest matching degree is taken as the second positioning result.
  20. 根据权利要求14至19中任一项所述的高精度地图定位方法,其特征在于,所述根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果,包括:The high-precision map positioning method according to any one of claims 14 to 19, wherein the target positioning result of the movable platform is determined according to the first positioning result and the second positioning result ,include:
    获取所述第一定位结果的匹配程度以及获取所述第二定位结果的匹配程度;Acquiring the matching degree of the first positioning result and acquiring the matching degree of the second positioning result;
    根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数;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;
    根据所述第一定位结果、第二定位结果、第一权重系数和第二权重系数,确定所述可移动平台的目标定位结果。According to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient, the target positioning result of the movable platform is determined.
  21. 根据权利要求20所述的高精度地图定位方法,其特征在于,所述根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数,包括:The high-precision map positioning method according to claim 20, wherein the first positioning result of the first positioning result is determined according to the matching degree of the first positioning result and the matching degree of the second positioning result. The weight coefficient and the second weight coefficient of the second positioning result include:
    对所述第一定位结果的匹配程度和所述第二定位结果的匹配程度进行归一化处理;Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
    根据处理后的所述第一定位结果的匹配程度和处理后的所述第二定位结果的匹配程度,确定总匹配程度;Determine the overall matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
    根据处理后的所述第一定位结果的匹配程度和所述总匹配程度,确定所述第一定位结果的第一权重系数;Determining the first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
    根据处理后的所述第二定位结果的匹配程度和所述总匹配程度,确定所述第二定位结果的第二权重系数。The second weight coefficient of the second positioning result is determined according to the matching degree of the second positioning result after processing and the total matching degree.
  22. 根据权利要求14至19中任一项所述的高精度地图定位方法,其特征在于,所述确定候选定位结果集,包括:The high-precision map positioning method according to any one of claims 14 to 19, wherein the determining a candidate positioning result set comprises:
    获取可移动平台的当前位置数据和当前姿态数据;Obtain the current position data and current posture data of the movable platform;
    根据所述当前位置数据确定候选位置集;Determining a candidate position set according to the current position data;
    根据所述当前姿态数据和预设姿态误差值确定候选姿态集;Determining a candidate pose set according to the current pose data and a preset pose error value;
    根据所述候选位置集和所述候选姿态集,确定候选定位结果集。According to the candidate position set and the candidate pose set, a candidate positioning result set is determined.
  23. 根据权利要求22所述的高精度地图定位方法,其特征在于,所述根据所述当前位置数据确定候选位置集,包括:The high-precision map positioning method according to claim 22, wherein the determining a candidate position set according to the current position data comprises:
    确定所述当前位置数据的变化趋势,并根据所述当前位置数据的变化趋势,确定候选位置集。The change trend of the current position data is determined, and a candidate position set is determined according to the change trend of the current position data.
  24. 根据权利要求22所述的高精度地图定位方法,其特征在于,所述根据所述当前姿态数据和预设姿态误差值确定候选姿态集,包括:The high-precision map positioning method according to claim 22, wherein the determining a candidate pose set according to the current pose data and a preset pose error value comprises:
    计算所述当前姿态数据中的姿态角与预设姿态误差值的差值,以及计算所述当前姿态数据中的姿态角与预设姿态误差值的和;Calculating the difference between the attitude angle in the current attitude data and the preset attitude error value, and calculating the sum of the attitude angle in the current attitude data and the preset attitude error value;
    根据所述当前姿态数据中的姿态角与预设姿态误差值的差值以及所述当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集。The candidate pose set is determined according to the difference 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.
  25. 根据权利要求14至19中任一项所述的高精度地图定位方法,其特征 在于,所述确定候选定位结果集,包括:The high-precision map positioning method according to any one of claims 14 to 19, wherein the determining a candidate positioning result set comprises:
    获取可移动平台的历史定位结果,所述历史定位结果为所述可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间;Acquiring a historical positioning result of the movable platform, where the historical positioning result is a positioning result determined by the movable platform at a previous time, and the previous time and the current time are separated by a preset time;
    根据所述历史定位结果确定候选定位结果集。A candidate positioning result set is determined according to the historical positioning result.
  26. 一种驾驶系统,其特征在于,所述驾驶系统包括激光雷达、存储器和处理器;A driving system, characterized in that, the driving system includes a lidar, a memory, and a processor;
    所述存储器用于存储计算机程序;The memory is used to store a computer program;
    所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
    获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间;Acquiring an offline high-precision map, and establishing an online point cloud map through the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes a plurality of first height intervals;
    确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间;Determine the candidate positioning result set, and perform 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 includes a plurality of second height intervals;
    根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。According to the multiple second height intervals in the online grid map and the multiple first height intervals in the offline high-precision map corresponding to each candidate positioning result, the movable platform is positioned to obtain the The first positioning result of the mobile platform.
  27. 根据权利要求26所述的驾驶系统,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果时,用于实现:The driving system according to claim 26, wherein the processor implements the multiple second height intervals in the online grid map corresponding to each candidate positioning result and the offline high-precision map. The multiple first height intervals of the mobile platform are positioned, and when the first positioning result of the mobile platform is obtained, it is used to realize:
    根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,确定每个候选定位结果各自对应的匹配程度;According to the multiple second height intervals in the online grid map and the multiple first height intervals in the offline high-precision map corresponding to each candidate positioning result, the matching degree corresponding to each candidate positioning result is determined ;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第一定位结果。According to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the first positioning result of the movable platform.
  28. 根据权利要求27所述的驾驶系统,其特征在于,所述离线高精度地图包括离线非地面高度层,所述多个第一高度区间位于所述离线非地面高度层,所述在线栅格地图包括在线非地面高度层,所述多个第二高度区间位于所述在线非地面高度层;所述处理器实现根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,确定每个候选定位结果各自对应的匹配程度时,用于实现:The driving system according to claim 27, wherein the offline high-precision map comprises an offline non-ground height layer, the plurality of first height intervals are located in the offline non-ground height layer, and the online grid map Including an online non-ground height layer, the multiple second height intervals are located in the online non-ground height layer; the processor implements multiple second height intervals in the online grid map corresponding to each candidate positioning result. The height interval and the multiple first height intervals in the offline high-precision map are used to determine the matching degree corresponding to each candidate positioning result to achieve:
    确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果;Determining a state comparison result between each of the second height intervals in each of the online non-ground height layers and the corresponding first height intervals in the offline non-ground height layers;
    统计每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数;Counting the number of the second height intervals in each of the online non-ground height layers where the state comparison result is a preset state comparison result;
    根据每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数,确定每个候选定位结果各自对应的匹配程度。According to the number of the second height intervals in each of the online non-ground height layers where the state comparison result is the preset state comparison result, the matching degree corresponding to each candidate positioning result is determined.
  29. 根据权利要求27所述的驾驶系统,其特征在于,所述处理器实现确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果时,用于实现:The driving system according to claim 27, wherein the processor is configured to determine that each of the second height intervals in each of the online non-ground height layers is different from those in the offline non-ground height layers. When the corresponding state comparison results between the first height intervals are used to realize:
    获取所述离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个所述在线非地面高度图层的各第二高度区间的第二状态标识信息;Acquiring first state identification information of each first height interval in the offline non-ground height layer and acquiring second state identification information of each second height interval in each of the online non-ground height layer;
    根据所述第一状态标识信息与每个所述第二状态标识信息,确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果。According to the first state identification information and each of the second state identification information, it is determined that each of the second height intervals in each of the online non-ground height layers is different from that in the offline non-ground height layer. The state comparison result between the corresponding first height intervals.
  30. 根据权利要求26至29中任一项所述的驾驶系统,其特征在于,所述在线栅格地图还包括在线完整高度图层,所述离线高精度地图还包括离线完整高度图层;所述处理器实现根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果之后,还用于实现:The driving system according to any one of claims 26 to 29, wherein the online raster map further includes an online complete height layer, and the offline high-precision map further includes an offline complete height layer; The processor realizes the positioning of the movable platform according to the multiple second height intervals in the online grid map and the multiple first height intervals in the offline high-precision map corresponding to each candidate positioning result, to obtain After the first positioning result of the movable platform, it is also used to achieve:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层对所述可移动平台进行定位,得到所述可移动平台的第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, to obtain a second positioning result of the movable platform;
    对所述第一定位结果和第二定位结果进行融合,得到所述可移动平台的目标定位结果。The first positioning result and the second positioning result are merged to obtain the target positioning result of the movable platform.
  31. 根据权利要求30所述的驾驶系统,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层对所述可移动平台进行定位,得到所述可移动平台的第二定位结果时,用于实现:The driving system according to claim 30, wherein the processor realizes that the online complete height layer and the offline complete height layer corresponding to each candidate positioning result are performed on the movable platform. Positioning, when the second positioning result of the movable platform is obtained, it is used to realize:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;Determine the matching degree corresponding to each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果。According to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the second positioning result of the movable platform.
  32. 根据权利要求31所述的驾驶系统,其特征在于,所述处理器实现根据 每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果时,用于实现:The driving system according to claim 31, wherein the processor realizes that according to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the mobile platform's When the second positioning result is used, it is used to achieve:
    根据每个候选定位结果各自对应的匹配程度,对所述候选定位结果集中的候选定位结果进行校验;Verifying the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
    获取通过校验的每个所述候选定位结果各自对应的匹配程度,并将最小的所述匹配程度对应的通过校验的所述候选定位结果作为所述可移动平台的第二定位结果。A matching degree corresponding to each candidate positioning result that has passed the verification is acquired, and the candidate positioning result that has passed the verification corresponding to the smallest matching degree is taken as the second positioning result of the movable platform.
  33. 根据权利要求30所述的驾驶系统,其特征在于,所述处理器实现对所述第一定位结果和第二定位结果进行融合,得到所述可移动平台的目标定位结果时,用于实现:The driving system according to claim 30, wherein the processor realizes the fusion of the first positioning result and the second positioning result to obtain the target positioning result of the movable platform, and is used to realize:
    获取所述第一定位结果的匹配程度以及获取所述第二定位结果的匹配程度;Acquiring the matching degree of the first positioning result and acquiring the matching degree of the second positioning result;
    根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数;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;
    根据所述第一定位结果、第二定位结果、第一权重系数和第二权重系数,确定所述可移动平台的目标定位结果。According to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient, the target positioning result of the movable platform is determined.
  34. 根据权利要求33所述的驾驶系统,其特征在于,所述处理器实现根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数时,用于实现:The driving system according to claim 33, wherein the processor realizes that the first positioning result of the first positioning result is determined according to the matching degree of the first positioning result and the matching degree of the second positioning result. The weight coefficient and the second weight coefficient of the second positioning result are used to realize:
    对所述第一定位结果的匹配程度和所述第二定位结果的匹配程度进行归一化处理;Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
    根据处理后的所述第一定位结果的匹配程度和处理后的所述第二定位结果的匹配程度,确定总匹配程度;Determine the overall matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
    根据处理后的所述第一定位结果的匹配程度和所述总匹配程度,确定所述第一定位结果的第一权重系数;Determining the first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
    根据处理后的所述第二定位结果的匹配程度和所述总匹配程度,确定所述第二定位结果的第二权重系数。The second weight coefficient of the second positioning result is determined according to the matching degree of the second positioning result after processing and the total matching degree.
  35. 根据权利要求26至29中任一项所述的驾驶系统,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The driving system according to any one of claims 26 to 29, wherein the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的当前位置数据和当前姿态数据;Obtain the current position data and current posture data of the movable platform;
    根据所述当前位置数据确定候选位置集;Determining a candidate position set according to the current position data;
    根据所述当前姿态数据和预设姿态误差值确定候选姿态集;Determining a candidate pose set according to the current pose data and a preset pose error value;
    根据所述候选位置集和所述候选姿态集,确定候选定位结果集。According to the candidate position set and the candidate pose set, a candidate positioning result set is determined.
  36. 根据权利要求35所述的驾驶系统,其特征在于,所述处理器实现根据所述当前位置数据确定候选位置集,用于实现:The driving system according to claim 35, wherein the processor realizes the determination of a candidate position set according to the current position data to realize:
    确定所述当前位置数据的变化趋势,并根据所述当前位置数据的变化趋势,确定候选位置集。The change trend of the current position data is determined, and a candidate position set is determined according to the change trend of the current position data.
  37. 根据权利要求35所述的驾驶系统,其特征在于,所述根据所述当前姿态数据和预设姿态误差值确定候选姿态集,用于实现:The driving system according to claim 35, wherein said determining a candidate posture set according to the current posture data and a preset posture error value is used to achieve:
    计算所述当前姿态数据中的姿态角与预设姿态误差值的差值,以及计算所述当前姿态数据中的姿态角与预设姿态误差值的和;Calculating the difference between the attitude angle in the current attitude data and the preset attitude error value, and calculating the sum of the attitude angle in the current attitude data and the preset attitude error value;
    根据所述当前姿态数据中的姿态角与预设姿态误差值的差值以及所述当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集。The candidate pose set is determined according to the difference 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.
  38. 根据权利要求26至29中任一项所述的驾驶系统,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The driving system according to any one of claims 26 to 29, wherein the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的历史定位结果,所述历史定位结果为所述可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间;Acquiring a historical positioning result of the movable platform, where the historical positioning result is a positioning result determined by the movable platform at a previous time, and the previous time and the current time are separated by a preset time;
    根据所述历史定位结果确定候选定位结果集。A candidate positioning result set is determined according to the historical positioning result.
  39. 一种驾驶系统,其特征在于,所述驾驶系统包括激光雷达、存储器和处理器;A driving system, characterized in that, the driving system includes a lidar, a memory, and a processor;
    所述存储器用于存储计算机程序;The memory is used to store a computer program;
    所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
    获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层;Acquiring an offline high-precision map, and establishing an online point cloud map from the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer;
    确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层;Determine the candidate positioning result set, and perform 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. Online raster map includes online complete height layer and online non-ground height layer;
    根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果;以及Positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result; and
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result;
    根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。According to the first positioning result and the second positioning result, the target positioning result of the movable platform is determined.
  40. 根据权利要求39所述的驾驶系统,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果,用于实现:The driving system according to claim 39, wherein the processor realizes that according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result, the The mobile platform performs positioning and obtains the first positioning result, which is used to achieve:
    确定每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度;Determining the degree of matching between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度,从所述候选定位结果集中确定第一定位结果。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, a first positioning result is determined from the candidate positioning result set.
  41. 根据权利要求40所述的驾驶系统,其特征在于,所述离线非地面高度图层包括多个第一高度区间,所述在线非地面高度图层包括多个第二高度区间,所述第一高度区间与对应的第二高度区间相同;所述处理器实现确定每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度,用于实现:The driving system according to claim 40, wherein the offline non-ground height layer includes a plurality of first height intervals, the online non-ground height layer includes a plurality of second height intervals, and the first The height interval is the same as the corresponding second height interval; the processor realizes the determination of the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result, for achieve:
    确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果;Determining a state comparison result between each of the second height intervals in each of the online non-ground height layers and the corresponding first height intervals in the offline non-ground height layers;
    统计每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数;Counting the number of the second height intervals in each of the online non-ground height layers where the state comparison result is a preset state comparison result;
    将每个所述个数,作为每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度。Use each of the numbers as the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result.
  42. 根据权利要求41所述的驾驶系统,其特征在于,所述处理器实现确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果,用于实现:The driving system according to claim 41, wherein the processor is configured to determine that each of the second height intervals in each of the online non-ground height layers is different from those in the offline non-ground height layers. The corresponding state comparison results between the first height intervals are used to achieve:
    获取所述离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个所述在线非地面高度图层的各第二高度区间的第二状态标识信息;Acquiring first state identification information of each first height interval in the offline non-ground height layer and acquiring second state identification information of each second height interval in each of the online non-ground height layer;
    根据每个所述第二状态标识信息与所述第一状态标识信息,确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果。According to each of the second state identification information and the first state identification information, it is determined that each of the second height intervals in each of the online non-ground height layers is different from that in the offline non-ground height layers. The state comparison result between the corresponding first height intervals.
  43. 根据权利要求39所述的驾驶系统,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果,用于实现:The driving system according to claim 39, wherein the processor implements the positioning of the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result. To obtain the second positioning result, which is used to achieve:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;Determine the matching degree corresponding to each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中确 定第二定位结果。According to the matching degree corresponding to each candidate positioning result, the second positioning result is determined from the candidate positioning result set.
  44. 根据权利要求43所述的驾驶系统,其特征在于,所述处理器实现根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中确定第二定位结果,用于实现:The driving system according to claim 43, wherein the processor realizes that the second positioning result is determined from the candidate positioning result set according to the matching degree corresponding to each candidate positioning result, so as to realize:
    根据每个候选定位结果各自对应的匹配程度,对所述候选定位结果集中的候选定位结果进行校验;Verifying the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
    获取通过校验的每个候选定位结果各自对应的匹配程度,并将最小的所述匹配程度对应的通过校验的候选定位结果作为第二定位结果。The matching degree corresponding to each candidate positioning result that passed the verification is acquired, and the candidate positioning result that passes the verification corresponding to the smallest matching degree is taken as the second positioning result.
  45. 根据权利要求39至44中任一项所述的驾驶系统,其特征在于,所述处理器实现根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果,用于实现:The driving system according to any one of claims 39 to 44, wherein the processor is configured to determine the target positioning result of the movable platform according to the first positioning result and the second positioning result To achieve:
    获取所述第一定位结果的匹配程度以及获取所述第二定位结果的匹配程度;Acquiring the matching degree of the first positioning result and acquiring the matching degree of the second positioning result;
    根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数;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;
    根据所述第一定位结果、第二定位结果、第一权重系数和第二权重系数,确定所述可移动平台的目标定位结果。According to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient, the target positioning result of the movable platform is determined.
  46. 根据权利要求45所述的驾驶系统,其特征在于,所述处理器实现根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数,用于实现:The driving system according to claim 45, wherein the processor determines the first position of the first positioning result according to the degree of matching of the first positioning result and the degree of matching of the second positioning result. The weight coefficient and the second weight coefficient of the second positioning result are used to achieve:
    对所述第一定位结果的匹配程度和所述第二定位结果的匹配程度进行归一化处理;Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
    根据处理后的所述第一定位结果的匹配程度和处理后的所述第二定位结果的匹配程度,确定总匹配程度;Determine the overall matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
    根据处理后的所述第一定位结果的匹配程度和所述总匹配程度,确定所述第一定位结果的第一权重系数;Determining the first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
    根据处理后的所述第二定位结果的匹配程度和所述总匹配程度,确定所述第二定位结果的第二权重系数。The second weight coefficient of the second positioning result is determined according to the matching degree of the second positioning result after processing and the total matching degree.
  47. 根据权利要求39至44中任一项所述的驾驶系统,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The driving system according to any one of claims 39 to 44, wherein the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的当前位置数据和当前姿态数据;Obtain the current position data and current posture data of the movable platform;
    根据所述当前位置数据确定候选位置集;Determining a candidate position set according to the current position data;
    根据所述当前姿态数据和预设姿态误差值确定候选姿态集;Determining a candidate pose set according to the current pose data and a preset pose error value;
    根据所述候选位置集和所述候选姿态集,确定候选定位结果集。According to the candidate position set and the candidate pose set, a candidate positioning result set is determined.
  48. 根据权利要求47所述的驾驶系统,其特征在于,所述处理器实现根据所述当前位置数据确定候选位置集,用于实现:The driving system according to claim 47, wherein the processor realizes the determination of a candidate position set according to the current position data to realize:
    确定所述当前位置数据的变化趋势,并根据所述当前位置数据的变化趋势,确定候选位置集。The change trend of the current position data is determined, and a candidate position set is determined according to the change trend of the current position data.
  49. 根据权利要求47所述的驾驶系统,其特征在于,所述处理器实现根据所述当前姿态数据和预设姿态误差值确定候选姿态集,用于实现:The driving system according to claim 47, wherein the processor implements the determination of a candidate posture set according to the current posture data and a preset posture error value, so as to realize:
    计算所述当前姿态数据中的姿态角与预设姿态误差值的差值,以及计算所述当前姿态数据中的姿态角与预设姿态误差值的和;Calculating the difference between the attitude angle in the current attitude data and the preset attitude error value, and calculating the sum of the attitude angle in the current attitude data and the preset attitude error value;
    根据所述当前姿态数据中的姿态角与预设姿态误差值的差值以及所述当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集。The candidate pose set is determined according to the difference 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.
  50. 根据权利要求39至44中任一项所述的驾驶系统,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The driving system according to any one of claims 39 to 44, wherein the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的历史定位结果,所述历史定位结果为所述可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间;Acquiring a historical positioning result of the movable platform, where the historical positioning result is a positioning result determined by the movable platform at a previous time, and the previous time and the current time are separated by a preset time;
    根据所述历史定位结果确定候选定位结果集。A candidate positioning result set is determined according to the historical positioning result.
  51. 一种可移动平台,其特征在于,所述可移动平台包括激光雷达、存储器和处理器;A movable platform, characterized in that the movable platform includes a lidar, a memory and a processor;
    所述存储器用于存储计算机程序;The memory is used to store a computer program;
    所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
    获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括多个第一高度区间;Acquiring an offline high-precision map, and establishing an online point cloud map through the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes a plurality of first height intervals;
    确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,其中,所述在线栅格地图包括多个第二高度区间;Determine the candidate positioning result set, and perform 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 includes a plurality of second height intervals;
    根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果。According to the multiple second height intervals in the online grid map and the multiple first height intervals in the offline high-precision map corresponding to each candidate positioning result, the movable platform is positioned to obtain the The first positioning result of the mobile platform.
  52. 根据权利要求51所述的可移动平台,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述 可移动平台的第一定位结果时,用于实现:The mobile platform according to claim 51, wherein the processor implements the multiple second height intervals in the online grid map corresponding to each candidate positioning result and the offline high-precision map A plurality of first height intervals in, positioning the movable platform, and when the first positioning result of the movable platform is obtained, it is used to realize:
    根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,确定每个候选定位结果各自对应的匹配程度;According to the multiple second height intervals in the online grid map and the multiple first height intervals in the offline high-precision map corresponding to each candidate positioning result, the matching degree corresponding to each candidate positioning result is determined ;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第一定位结果。According to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the first positioning result of the movable platform.
  53. 根据权利要求52所述的可移动平台,其特征在于,所述离线高精度地图包括离线非地面高度层,所述多个第一高度区间位于所述离线非地面高度层,所述在线栅格地图包括在线非地面高度层,所述多个第二高度区间位于所述在线非地面高度层;所述处理器实现根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,确定每个候选定位结果各自对应的匹配程度时,用于实现:The mobile platform according to claim 52, wherein the offline high-precision map comprises an offline non-ground height layer, the plurality of first height intervals are located in the offline non-ground height layer, and the online grid The map includes an online non-ground height layer, and the plurality of second height intervals are located in the online non-ground height layer; the processor implements a plurality of second height intervals in the online grid map corresponding to each candidate positioning result. The second height interval and the multiple first height intervals in the offline high-precision map are used to determine the matching degree of each candidate positioning result to achieve:
    确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果;Determining a state comparison result between each of the second height intervals in each of the online non-ground height layers and the corresponding first height intervals in the offline non-ground height layers;
    统计每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数;Counting the number of the second height intervals in each of the online non-ground height layers where the state comparison result is a preset state comparison result;
    根据每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数,确定每个候选定位结果各自对应的匹配程度。According to the number of the second height intervals in each of the online non-ground height layers where the state comparison result is the preset state comparison result, the matching degree corresponding to each candidate positioning result is determined.
  54. 根据权利要求53所述的可移动平台,其特征在于,所述处理器实现确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果时,用于实现:The mobile platform according to claim 53, wherein the processor is configured to determine that each of the second height intervals in each of the online non-ground height layers is different from the offline non-ground height layers When the state comparison result between the corresponding first height intervals in, it is used to realize:
    获取所述离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个所述在线非地面高度图层的各第二高度区间的第二状态标识信息;Acquiring first state identification information of each first height interval in the offline non-ground height layer and acquiring second state identification information of each second height interval in each of the online non-ground height layer;
    根据所述第一状态标识信息与每个所述第二状态标识信息,确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果。According to the first state identification information and each of the second state identification information, it is determined that each of the second height intervals in each of the online non-ground height layers is different from that in the offline non-ground height layer. The state comparison result between the corresponding first height intervals.
  55. 根据权利要求51至54中任一项所述的可移动平台,其特征在于,所述在线栅格地图还包括在线完整高度图层,所述离线高精度地图还包括离线完整高度图层;所述处理器实现根据每个候选定位结果各自对应的所述在线栅格地图中的多个第二高度区间和所述离线高精度地图中的多个第一高度区间,对可移动平台进行定位,得到所述可移动平台的第一定位结果之后,还用于实现:The mobile platform according to any one of claims 51 to 54, wherein the online raster map further includes an online complete height layer, and the offline high-precision map further includes an offline complete height layer; The processor realizes the positioning of the movable platform according to the plurality of second height intervals in the online grid map and the plurality of first height intervals in the offline high-precision map corresponding to each candidate positioning result, After obtaining the first positioning result of the movable platform, it is also used to achieve:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整 高度图层对所述可移动平台进行定位,得到所述可移动平台的第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result, to obtain a second positioning result of the movable platform;
    对所述第一定位结果和第二定位结果进行融合,得到所述可移动平台的目标定位结果。The first positioning result and the second positioning result are merged to obtain the target positioning result of the movable platform.
  56. 根据权利要求55所述的可移动平台,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层对所述可移动平台进行定位,得到所述可移动平台的第二定位结果时,用于实现:The mobile platform according to claim 55, wherein the processor realizes that the online complete height layer and the offline complete height layer corresponding to each of the candidate positioning results can be compared to the mobile platform. When positioning is performed, when the second positioning result of the movable platform is obtained, it is used to achieve:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;Determine the matching degree corresponding to each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果。According to the matching degree of each candidate positioning result, one candidate positioning result is selected from the candidate positioning result set as the second positioning result of the movable platform.
  57. 根据权利要求56所述的可移动平台,其特征在于,所述处理器实现根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中选择一个候选定位结果作为所述可移动平台的第二定位结果时,用于实现:The mobile platform according to claim 56, wherein the processor realizes that according to the matching degree of each candidate positioning result, one candidate positioning result is selected as the movable platform from the candidate positioning result set. When the second positioning result is used to achieve:
    根据每个候选定位结果各自对应的匹配程度,对所述候选定位结果集中的候选定位结果进行校验;Verifying the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
    获取通过校验的每个所述候选定位结果各自对应的匹配程度,并将最小的所述匹配程度对应的通过校验的所述候选定位结果作为所述可移动平台的第二定位结果。A matching degree corresponding to each candidate positioning result that has passed the verification is acquired, and the candidate positioning result that has passed the verification corresponding to the smallest matching degree is taken as the second positioning result of the movable platform.
  58. 根据权利要求55所述的可移动平台,其特征在于,所述处理器实现对所述第一定位结果和第二定位结果进行融合,得到所述可移动平台的目标定位结果时,用于实现:The movable platform according to claim 55, wherein the processor realizes the fusion of the first positioning result and the second positioning result, and when the target positioning result of the movable platform is obtained, it is used to realize :
    获取所述第一定位结果的匹配程度以及获取所述第二定位结果的匹配程度;Acquiring the matching degree of the first positioning result and acquiring the matching degree of the second positioning result;
    根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数;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;
    根据所述第一定位结果、第二定位结果、第一权重系数和第二权重系数,确定所述可移动平台的目标定位结果。According to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient, the target positioning result of the movable platform is determined.
  59. 根据权利要求58所述的可移动平台,其特征在于,所述处理器实现根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数时,用于实现:The movable platform according to claim 58, wherein the processor realizes that the first positioning result is determined according to the matching degree of the first positioning result and the matching degree of the second positioning result. A weight coefficient and a second weight coefficient of the second positioning result are used to realize:
    对所述第一定位结果的匹配程度和所述第二定位结果的匹配程度进行归一 化处理;Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
    根据处理后的所述第一定位结果的匹配程度和处理后的所述第二定位结果的匹配程度,确定总匹配程度;Determine the overall matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
    根据处理后的所述第一定位结果的匹配程度和所述总匹配程度,确定所述第一定位结果的第一权重系数;Determining the first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
    根据处理后的所述第二定位结果的匹配程度和所述总匹配程度,确定所述第二定位结果的第二权重系数。The second weight coefficient of the second positioning result is determined according to the matching degree of the second positioning result after processing and the total matching degree.
  60. 根据权利要求51至54中任一项所述的可移动平台,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The mobile platform according to any one of claims 51 to 54, characterized in that the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的当前位置数据和当前姿态数据;Obtain the current position data and current posture data of the movable platform;
    根据所述当前位置数据确定候选位置集;Determining a candidate position set according to the current position data;
    根据所述当前姿态数据和预设姿态误差值确定候选姿态集;Determining a candidate pose set according to the current pose data and a preset pose error value;
    根据所述候选位置集和所述候选姿态集,确定候选定位结果集。According to the candidate position set and the candidate pose set, a candidate positioning result set is determined.
  61. 根据权利要求60所述的可移动平台,其特征在于,所述处理器实现根据所述当前位置数据确定候选位置集,用于实现:The mobile platform according to claim 60, wherein the processor realizes the determination of a candidate position set according to the current position data for realizing:
    确定所述当前位置数据的变化趋势,并根据所述当前位置数据的变化趋势,确定候选位置集。The change trend of the current position data is determined, and a candidate position set is determined according to the change trend of the current position data.
  62. 根据权利要求60所述的可移动平台,其特征在于,所述根据所述当前姿态数据和预设姿态误差值确定候选姿态集,用于实现:The mobile platform according to claim 60, wherein the candidate pose set is determined according to the current pose data and a preset pose error value to achieve:
    计算所述当前姿态数据中的姿态角与预设姿态误差值的差值,以及计算所述当前姿态数据中的姿态角与预设姿态误差值的和;Calculating the difference between the attitude angle in the current attitude data and the preset attitude error value, and calculating the sum of the attitude angle in the current attitude data and the preset attitude error value;
    根据所述当前姿态数据中的姿态角与预设姿态误差值的差值以及所述当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集。The candidate pose set is determined according to the difference 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.
  63. 根据权利要求51至54中任一项所述的可移动平台,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The mobile platform according to any one of claims 51 to 54, characterized in that the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的历史定位结果,所述历史定位结果为所述可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间;Acquiring a historical positioning result of the movable platform, where the historical positioning result is a positioning result determined by the movable platform at a previous time, and the previous time and the current time are separated by a preset time;
    根据所述历史定位结果确定候选定位结果集。A candidate positioning result set is determined according to the historical positioning result.
  64. 一种可移动平台,其特征在于,所述可移动平台包括激光雷达、存储器和处理器;A movable platform, characterized in that the movable platform includes a lidar, a memory and a processor;
    所述存储器用于存储计算机程序;The memory is used to store a computer program;
    所述处理器,用于执行所述计算机程序并在执行所述计算机程序时,实现 如下步骤:The processor is configured to execute the computer program and, when executing the computer program, implement the following steps:
    获取离线高精度地图,并通过所述激光雷达采集到的三维点云数据建立在线点云地图,其中,所述离线高精度地图包括离线完整高度图层和离线非地面高度图层;Acquiring an offline high-precision map, and establishing an online point cloud map from the three-dimensional point cloud data collected by the lidar, where the offline high-precision map includes an offline complete height layer and an offline non-ground height layer;
    确定候选定位结果集,并根据所述候选定位结果集中的每个候选定位结果,对所述在线点云地图进行栅格化处理,得到每个候选定位结果各自对应的在线栅格地图,所述在线栅格地图包括在线完整高度图层和在线非地面高度图层;Determine the candidate positioning result set, and perform 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. Online raster map includes online complete height layer and online non-ground height layer;
    根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果;以及Positioning the movable platform according to the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result to obtain a first positioning result; and
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果;Positioning the movable platform according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result to obtain a second positioning result;
    根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果。According to the first positioning result and the second positioning result, the target positioning result of the movable platform is determined.
  65. 根据权利要求64所述的可移动平台,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线非地面高度图层和所述离线非地面高度图层,对所述可移动平台进行定位,得到第一定位结果,用于实现:The mobile platform according to claim 64, wherein the processor realizes that the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result are processed for the The movable platform performs positioning and obtains the first positioning result, which is used to achieve:
    确定每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度;Determining the degree of matching between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度,从所述候选定位结果集中确定第一定位结果。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, a first positioning result is determined from the candidate positioning result set.
  66. 根据权利要求65所述的可移动平台,其特征在于,所述离线非地面高度图层包括多个第一高度区间,所述在线非地面高度图层包括多个第二高度区间,所述第一高度区间与对应的第二高度区间相同;所述处理器实现确定每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度,用于实现:The mobile platform of claim 65, wherein the offline non-ground height layer includes a plurality of first height intervals, the online non-ground height layer includes a plurality of second height intervals, and the first A height interval is the same as the corresponding second height interval; the processor realizes the determination of the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result, using To achieve:
    确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果;Determining a state comparison result between each of the second height intervals in each of the online non-ground height layers and the corresponding first height intervals in the offline non-ground height layers;
    统计每个所述在线非地面高度图层中所述状态比较结果为预设状态比较结果的所述第二高度区间的个数;Counting the number of the second height intervals in each of the online non-ground height layers where the state comparison result is a preset state comparison result;
    将每个所述个数,作为每个候选定位结果各自对应的所述在线非地面高度图层与所述离线非地面高度图层之间的匹配程度。Use each of the numbers as the matching degree between the online non-ground height layer and the offline non-ground height layer corresponding to each candidate positioning result.
  67. 根据权利要求66所述的可移动平台,其特征在于,所述处理器实现确 定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果,用于实现:The mobile platform according to claim 66, wherein the processor is configured to determine that each of the second height intervals in each of the online non-ground height layers is different from the offline non-ground height layer The state comparison result between the corresponding first height intervals in, is used to realize:
    获取所述离线非地面高度图层中各第一高度区间的第一状态标识信息以及获取每个所述在线非地面高度图层的各第二高度区间的第二状态标识信息;Acquiring first state identification information of each first height interval in the offline non-ground height layer and acquiring second state identification information of each second height interval in each of the online non-ground height layer;
    根据每个所述第二状态标识信息与所述第一状态标识信息,确定每个所述在线非地面高度图层中的各所述第二高度区间,与所述离线非地面高度图层中对应的所述第一高度区间之间的状态比较结果。According to each of the second state identification information and the first state identification information, it is determined that each of the second height intervals in each of the online non-ground height layers is different from that in the offline non-ground height layers. The state comparison result between the corresponding first height intervals.
  68. 根据权利要求64所述的可移动平台,其特征在于,所述处理器实现根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,对可移动平台进行定位,得到第二定位结果,用于实现:The mobile platform according to claim 64, wherein the processor realizes that the online complete height layer and the offline complete height layer corresponding to each candidate positioning result are performed on the mobile platform. Positioning to obtain the second positioning result, which is used to achieve:
    根据每个候选定位结果各自对应的所述在线完整高度图层和所述离线完整高度图层,确定每个候选定位结果各自对应的匹配程度;Determine the matching degree corresponding to each candidate positioning result according to the online complete height layer and the offline complete height layer corresponding to each candidate positioning result;
    根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中确定第二定位结果。According to the matching degree of each candidate positioning result, the second positioning result is determined from the candidate positioning result set.
  69. 根据权利要求68所述的可移动平台,其特征在于,所述处理器实现根据每个候选定位结果各自对应的匹配程度,从所述候选定位结果集中确定第二定位结果,用于实现:The mobile platform according to claim 68, wherein the processor realizes that the second positioning result is determined from the candidate positioning result set according to the matching degree corresponding to each candidate positioning result, and is used to realize:
    根据每个候选定位结果各自对应的匹配程度,对所述候选定位结果集中的候选定位结果进行校验;Verifying the candidate positioning results in the candidate positioning result set according to the matching degree corresponding to each candidate positioning result;
    获取通过校验的每个候选定位结果各自对应的匹配程度,并将最小的所述匹配程度对应的通过校验的候选定位结果作为第二定位结果。The matching degree corresponding to each candidate positioning result that passed the verification is acquired, and the candidate positioning result that passes the verification corresponding to the smallest matching degree is taken as the second positioning result.
  70. 根据权利要求64至69中任一项所述的可移动平台,其特征在于,所述处理器实现根据所述第一定位结果和所述第二定位结果,确定所述可移动平台的目标定位结果,用于实现:The movable platform according to any one of claims 64 to 69, wherein the processor is configured to determine the target location of the movable platform according to the first positioning result and the second positioning result As a result, used to achieve:
    获取所述第一定位结果的匹配程度以及获取所述第二定位结果的匹配程度;Acquiring the matching degree of the first positioning result and acquiring the matching degree of the second positioning result;
    根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数;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;
    根据所述第一定位结果、第二定位结果、第一权重系数和第二权重系数,确定所述可移动平台的目标定位结果。According to the first positioning result, the second positioning result, the first weight coefficient and the second weight coefficient, the target positioning result of the movable platform is determined.
  71. 根据权利要求70所述的可移动平台,其特征在于,所述处理器实现根据所述第一定位结果的匹配程度和所述第二定位结果的匹配程度,确定所述第一定位结果的第一权重系数以及所述第二定位结果的第二权重系数,用于实现:The movable platform according to claim 70, wherein the processor is configured to determine the first positioning result of the first positioning result according to the matching degree of the first positioning result and the matching degree of the second positioning result. A weight coefficient and the second weight coefficient of the second positioning result are used to achieve:
    对所述第一定位结果的匹配程度和所述第二定位结果的匹配程度进行归一化处理;Normalizing the matching degree of the first positioning result and the matching degree of the second positioning result;
    根据处理后的所述第一定位结果的匹配程度和处理后的所述第二定位结果的匹配程度,确定总匹配程度;Determine the overall matching degree according to the matching degree of the processed first positioning result and the matching degree of the processed second positioning result;
    根据处理后的所述第一定位结果的匹配程度和所述总匹配程度,确定所述第一定位结果的第一权重系数;Determining the first weight coefficient of the first positioning result according to the processed matching degree of the first positioning result and the total matching degree;
    根据处理后的所述第二定位结果的匹配程度和所述总匹配程度,确定所述第二定位结果的第二权重系数。The second weight coefficient of the second positioning result is determined according to the matching degree of the second positioning result after processing and the total matching degree.
  72. 根据权利要求64至69中任一项所述的可移动平台,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The movable platform according to any one of claims 64 to 69, wherein the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的当前位置数据和当前姿态数据;Obtain the current position data and current posture data of the movable platform;
    根据所述当前位置数据确定候选位置集;Determining a candidate position set according to the current position data;
    根据所述当前姿态数据和预设姿态误差值确定候选姿态集;Determining a candidate pose set according to the current pose data and a preset pose error value;
    根据所述候选位置集和所述候选姿态集,确定候选定位结果集。According to the candidate position set and the candidate pose set, a candidate positioning result set is determined.
  73. 根据权利要求72所述的可移动平台,其特征在于,所述处理器实现根据所述当前位置数据确定候选位置集,用于实现:The mobile platform according to claim 72, wherein the processor realizes the determination of a candidate position set according to the current position data for realizing:
    确定所述当前位置数据的变化趋势,并根据所述当前位置数据的变化趋势,确定候选位置集。The change trend of the current position data is determined, and a candidate position set is determined according to the change trend of the current position data.
  74. 根据权利要求72所述的可移动平台,其特征在于,所述处理器实现根据所述当前姿态数据和预设姿态误差值确定候选姿态集,用于实现:The mobile platform according to claim 72, wherein the processor implements the determination of a candidate pose set according to the current pose data and a preset pose error value, and is used to implement:
    计算所述当前姿态数据中的姿态角与预设姿态误差值的差值,以及计算所述当前姿态数据中的姿态角与预设姿态误差值的和;Calculating the difference between the attitude angle in the current attitude data and the preset attitude error value, and calculating the sum of the attitude angle in the current attitude data and the preset attitude error value;
    根据所述当前姿态数据中的姿态角与预设姿态误差值的差值以及所述当前姿态数据中的姿态角与预设姿态误差值的和,确定候选姿态集。The candidate pose set is determined according to the difference 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.
  75. 根据权利要求64至69中任一项所述的可移动平台,其特征在于,所述处理器实现确定候选定位结果集,用于实现:The movable platform according to any one of claims 64 to 69, wherein the processor realizes the determination of a candidate positioning result set for realizing:
    获取可移动平台的历史定位结果,所述历史定位结果为所述可移动平台在上一时刻所确定的定位结果,且上一时刻与当前时刻间隔预设时间;Acquiring a historical positioning result of the movable platform, where the historical positioning result is a positioning result determined by the movable platform at a previous time, and the previous time and the current time are separated by a preset time;
    根据所述历史定位结果确定候选定位结果集。A candidate positioning result set is determined according to the historical positioning result.
  76. 一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时使所述处理器实现如权利要求1至25中任一项所述的高精度地图定位方法。A computer-readable storage medium, characterized in that the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor realizes as described in any one of claims 1 to 25. The high-precision map positioning method described.
PCT/CN2019/106792 2019-09-19 2019-09-19 High-precision map positioning method and system, platform and computer-readable storage medium WO2021051361A1 (en)

Priority Applications (2)

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
CN201980032943.3A CN112154355B (en) 2019-09-19 2019-09-19 High-precision map positioning method, system, platform and computer readable storage medium

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 (1)

Publication Number Publication Date
WO2021051361A1 true WO2021051361A1 (en) 2021-03-25

Family

ID=73891528

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/106792 WO2021051361A1 (en) 2019-09-19 2019-09-19 High-precision map positioning method and 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 (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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
WO2017175163A1 (en) * 2016-04-07 2017-10-12 Kaushish Ketan A method and system for optimizing an itinerary and navigating through the itinerary
CN109084732A (en) * 2018-06-29 2018-12-25 北京旷视科技有限公司 Positioning and air navigation aid, device and processing equipment
CN109353179A (en) * 2018-10-19 2019-02-19 中国第汽车股份有限公司 A kind of active suspension system and control method based on high-precision map cloud information
CN109725329A (en) * 2019-02-20 2019-05-07 苏州风图智能科技有限公司 A kind of unmanned vehicle localization method and device
CN110246182A (en) * 2019-05-29 2019-09-17 深圳前海达闼云端智能科技有限公司 Vision-based global map positioning method and device, storage medium and equipment

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105928505B (en) * 2016-04-19 2019-01-29 深圳市神州云海智能科技有限公司 The pose of mobile robot determines method and apparatus
CN108225341B (en) * 2016-12-14 2021-06-18 法法汽车(中国)有限公司 Vehicle positioning method
CN106908775B (en) * 2017-03-08 2019-10-18 同济大学 A kind of unmanned vehicle real-time location method based on laser reflection intensity
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
CN109781119B (en) * 2017-11-15 2020-01-21 百度在线网络技术(北京)有限公司 Laser point cloud positioning method and system
CN109064506B (en) * 2018-07-04 2020-03-13 百度在线网络技术(北京)有限公司 High-precision map generation method and device and storage medium
CN108897334B (en) * 2018-07-19 2020-03-17 上海交通大学 Method for controlling attitude of insect-imitating flapping wing aircraft based on fuzzy neural network

Patent Citations (7)

* 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
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
CN109084732A (en) * 2018-06-29 2018-12-25 北京旷视科技有限公司 Positioning and air navigation aid, device and processing equipment
CN109353179A (en) * 2018-10-19 2019-02-19 中国第汽车股份有限公司 A kind of active suspension system and control method based on high-precision map cloud information
CN109725329A (en) * 2019-02-20 2019-05-07 苏州风图智能科技有限公司 A kind of unmanned vehicle localization method and device
CN110246182A (en) * 2019-05-29 2019-09-17 深圳前海达闼云端智能科技有限公司 Vision-based global map positioning method and device, storage medium and equipment

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
LUO, WENTING ET AL.: "The 3D Roadway Alignment Measurement for High Definition Map", BULLETIN OF SURVEYING AND MAPPING, no. 12, 31 December 2018 (2018-12-31), pages 46 - 51, XP055793251 *

Also Published As

Publication number Publication date
CN112154355A (en) 2020-12-29
CN112154355B (en) 2024-03-01

Similar Documents

Publication Publication Date Title
US11030803B2 (en) Method and apparatus for generating raster map
CN109270545B (en) Positioning true value verification method, device, equipment and storage medium
JP5062498B2 (en) Reference data generation system and position positioning system for landscape matching
EP3407294A1 (en) Information processing method, device, and terminal
CN109143207A (en) Laser radar internal reference precision test method, apparatus, equipment and medium
KR20190082070A (en) Methods and apparatuses for map generation and moving entity localization
CN108279670B (en) Method, apparatus and computer readable medium for adjusting point cloud data acquisition trajectory
CN112667837A (en) Automatic image data labeling method and device
US8467612B2 (en) System and methods for navigation using corresponding line features
JP2011215973A (en) Scene matching reference data generation system and position measurement system
CN107527382B (en) Data processing method and device
JP2022539422A (en) METHOD AND APPARATUS FOR CONSTRUCTING SIGNS MAP BASED ON VISUAL SIGNS
WO2021016806A1 (en) High-precision map positioning method, system and platform, and computer-readable storage medium
CN109523579B (en) Method and device for matching video image of unmanned aerial vehicle with three-dimensional map
WO2021051361A1 (en) High-precision map positioning method and system, platform and computer-readable storage medium
CN112154303B (en) High-precision map positioning method, system, platform and computer readable storage medium
CN113137968A (en) Repositioning method and repositioning device based on multi-sensor fusion and electronic equipment
US11629963B2 (en) Efficient map matching method for autonomous driving and apparatus thereof
CN110515110B (en) Method, device, equipment and computer readable storage medium for data evaluation
JP6673504B2 (en) Information processing device, database generation device, method, program, and storage medium
CN111812669A (en) Winding inspection device, positioning method thereof and storage medium
CN111208526A (en) Multi-unmanned aerial vehicle cooperative positioning method based on laser radar and positioning vector matching
CN113034347B (en) Oblique photography image processing method, device, processing equipment and storage medium
CN110926405B (en) ARV attitude measurement method based on monocular vision vanishing point detection
CN115900697B (en) Object motion trail information processing method, electronic equipment and automatic driving vehicle

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19945771

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19945771

Country of ref document: EP

Kind code of ref document: A1