World-centric positioning and global map optimization method, device and equipment

By updating the global map using state estimation error and measurement residual constraints under the world coordinate system, the problem of inaccurate global map construction in the existing technology is solved, and high-precision global map construction and positioning are realized, reducing computing resources consumption.

CN115683122BActive Publication Date: 2024-12-06INST OF AUTOMATION CHINESE ACAD OF SCI
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202211313538.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-10-25
Publication Date
2024-12-06
Estimated Expiration
2042-10-25

AI Technical Summary

Technical Problem

The existing global map construction method has limitations, which leads to the target global map acquired by the robot being inaccurate enough, especially in the process of coupling lidar data and IMU data, which requires high computing resources and complex data processing, which affects the map's accuracy.

Method used

By using the equivalent prior distribution of the final state estimation error and measuring residual constraints in the world coordinate system, the global map of the electronic device in the current environment is updated, thereby achieving accurate global map construction and positioning. The specific steps include obtaining lidar data and IMU data, determining the initial state estimate value and measuring residual constraints, and iteratively processing using invariant extended Kalman filtering to obtain the final state estimation error and pose update.

Benefits of technology

The global map is updated effectively and accurately, which improves the robot's positioning accuracy in the environment and the accuracy of map construction, reduces the consumption of computing resources, and obtains a higher quality global map.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115683122B_ABST
    Figure CN115683122B_ABST
Patent Text Reader

Abstract

The present invention provides a world-centric positioning and global map optimization method, device and equipment, the method comprising: obtaining the current global map and the inertial measurement unit IMU data in the time period corresponding to the first frame laser radar data and the second frame laser radar data, the first frame laser radar data and the second frame laser radar data are adjacent frame data; determining the initial state estimation value corresponding to the second frame laser radar data of the electronic device in the world coordinate system according to the IMU data; determining the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system according to the initial state estimation value, and determining the measurement residual constraint in the world coordinate system according to the first feature point corresponding to the second laser radar data; determining the current posture corresponding to the electronic device according to the equivalent prior distribution and the measurement residual constraint, and updating the current global map to obtain the target global map. The method can accurately obtain the posture of the electronic device in the current environment and the target global map.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of map construction technology, and in particular to a world-centric positioning and global map optimization method, device and equipment. Background Art

[0002] The ability to estimate the pose with 6 degrees of freedom and build dense maps of unknown environments is a basic prerequisite for robot applications. With the rapid development of the field of autonomous driving, LiDAR (Light Detection and Ranging) sensors and Inertial Measurement Units (IMU) have become extremely popular. Robots can use the LiDAR data collected by the LiDAR sensor and the IMU data collected by the IMU to build a global map of the robot's environment.

[0003] The existing global map construction methods have the following defects: LiDAR sensors collect a large amount of laser radar data, but not all laser radar data is conducive to the construction of global maps. In addition, the robot requires high computing resources in the process of coupling laser radar data with IMU data, and the data processing process is relatively complex, which is also not conducive to the construction of global maps. In other words, the existing global map construction methods have certain limitations, resulting in the problem that the target global map finally obtained by the robot will not be accurate enough. Summary of the invention

[0004] The present invention provides a world-centric positioning and global map optimization method, device and equipment, which are used to solve the problem that the existing global map construction method has certain limitations, resulting in the defect that the target global map finally obtained by the robot is not accurate enough. By utilizing the equivalent prior distribution and measurement residual constraints corresponding to the final state estimation error in the world coordinate system, the current global map corresponding to the current environment where the electronic device is located can be effectively and accurately updated, thereby obtaining a target global map with higher accuracy. In addition, the electronic device can also accurately obtain the current posture of the electronic device in the current environment where the electronic device is located.

[0005] The present invention provides a world-centric positioning and global map optimization method, comprising:

[0006] Acquire the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data, where the first frame of laser radar data and the second frame of laser radar data are adjacent frame data;

[0007] Determine, based on the IMU data, an initial state estimation value of the electronic device corresponding to the second frame of laser radar data in a world coordinate system;

[0008] Determine an equivalent prior distribution corresponding to a final state estimation error in the world coordinate system according to the initial state estimation value, and determine a measurement residual constraint in the world coordinate system according to a first feature point corresponding to the second laser radar data;

[0009] According to the equivalent prior distribution and the measurement residual constraint, the current posture corresponding to the electronic device is determined, and the current global map is updated to obtain a target global map.

[0010] According to a world-centric positioning and global map optimization method provided by the present invention, the initial state estimate value corresponding to the second frame of lidar data of the electronic device in the world coordinate system is determined based on the IMU data, including: determining the first kinematic model, the current system state and the current state error corresponding to the current system state of the electronic device in the world coordinate system based on the IMU data; determining the second kinematic model corresponding to the current state error based on the first kinematic model, the current system state and the current state error; determining the initial state estimate value corresponding to the second frame of lidar data based on the second kinematic model.

[0011] According to a world-centric positioning and global map optimization method provided by the present invention, the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system is determined based on the initial state estimation value, including: determining the real system state corresponding to the electronic device in the world coordinate system and the estimated state error corresponding to the estimated system state based on the initial state estimation value; determining the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system based on the real system state and the estimated state error.

[0012] According to a world-centric positioning and global map optimization method provided by the present invention, the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system is determined according to the real system state and the estimated state error, including: determining the maximum a posteriori probability estimate corresponding to the real system state according to the real system state and the prior estimate; iteratively processing the maximum a posteriori probability estimate to obtain the final state estimation error; and determining the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system according to the estimated state error.

[0013] According to a world-centric positioning and global map optimization method provided by the present invention, the measurement residual constraint in the world coordinate system is determined based on the first feature point corresponding to the second laser radar data, including: converting the first feature point corresponding to the second laser radar data to the world coordinate system to obtain a second feature point; establishing a first residual function corresponding to the second feature point to the edge and a second residual function corresponding to the second feature to the surface; and determining the measurement residual constraint based on the first residual function and the second residual function.

[0014] According to a world-centric positioning and global map optimization method provided by the present invention, the measurement residual constraint is determined based on the first residual function and the second residual function, including: linearizing the first residual function to obtain a first target residual function; linearizing the second residual function to obtain a second target residual function; and determining the measurement residual constraint based on the first target residual function and the second target residual function.

[0015] According to a world-centric positioning and global map optimization method provided by the present invention, the current posture corresponding to the electronic device is determined according to the equivalent prior distribution and the measurement residual constraint, and the current global map is updated to obtain a target global map, including: determining a target system state update group corresponding to the second frame of lidar data according to the equivalent prior distribution and the measurement residual constraint; using the target system state update group, determining the current posture corresponding to the electronic device, and updating the coordinates of the current global map in the world coordinate system to obtain a target global map.

[0016] The present invention also provides a positioning and global map optimization device, comprising:

[0017] An acquisition module is used to acquire the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data, where the first frame of laser radar data and the second frame of laser radar data are adjacent frame data;

[0018] A processing module is used to determine, based on the IMU data, an initial state estimate corresponding to the second frame of lidar data in a world coordinate system; based on the initial state estimate, determine an equivalent prior distribution corresponding to a final state estimate error in the world coordinate system, and based on a first feature point corresponding to the second lidar data, determine a measurement residual constraint in the world coordinate system; based on the equivalent prior distribution and the measurement residual constraint, determine a current posture corresponding to the electronic device, and update the current global map to obtain a target global map.

[0019] The present invention also provides an electronic device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, the world-centric positioning and global map optimization method as described above is implemented.

[0020] The present invention also provides a non-transitory computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements any of the world-centric positioning and global map optimization methods described above.

[0021] The present invention also provides a computer program product, comprising a computer program, which, when executed by a processor, implements any of the world-centric positioning and global map optimization methods described above.

[0022] The world-centric positioning and global map optimization method, device and equipment provided by the present invention obtain the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data, the first frame of laser radar data and the second frame of laser radar data being adjacent frame data; according to the IMU data, the initial state estimation value of the electronic device corresponding to the second frame of laser radar data in the world coordinate system is determined; according to the initial state estimation value, the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system is determined, and according to the first feature point corresponding to the second laser radar data, the measurement residual constraint in the world coordinate system is determined; according to the equivalent prior distribution and the measurement residual constraint, the current posture corresponding to the electronic device is determined, and the current global map is updated to obtain the target global map. This method is used to solve the problem that the existing global map construction method has certain limitations, which leads to the defect that the target global map finally obtained by the robot is not accurate enough. It realizes the use of the equivalent prior distribution and measurement residual constraints corresponding to the final state estimation error in the world coordinate system, and can effectively and accurately update the current global map corresponding to the current environment where the electronic device is located, thereby obtaining a target global map with higher accuracy. In addition, the electronic device can also accurately obtain the current posture of the electronic device in the current environment. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] In order to more clearly illustrate the technical solutions in the present invention or the prior art, the following briefly introduces the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0024] Figure 1 It is a flow chart of the world-centric positioning and global map optimization method provided by the present invention;

[0025] Figure 2 It is a scene schematic diagram of the world-centric positioning and global map optimization method provided by the present invention;

[0026] Figure 3 It is a structural schematic diagram of the positioning and global map optimization device provided by the present invention;

[0027] Figure 4 It is a structural schematic diagram of the electronic device provided by the present invention. DETAILED DESCRIPTION

[0028] In order to make the purpose, technical solution and advantages of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in conjunction with the drawings of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0029] It should be noted that the electronic device involved in the embodiment of the present invention may be a robot, which refers to a machine that can automatically perform a series of complex actions under computer programming and can replace human work in various complex environments.

[0030] Optionally, the electronic device may be provided with a lidar sensor, which is used to collect lidar data.

[0031] Among them, the lidar data is three-dimensional point cloud data.

[0032] Optionally, the electronic device may be provided with an inertial measurement unit IMU, which is used to collect IMU data.

[0033] Optionally, the IMU may include: an accelerometer and a gyroscope.

[0034] Among them, the accelerometer is used to collect acceleration data;

[0035] The gyroscope is used to collect angular velocity data.

[0036] For example, since the data collection frequency of the LiDAR sensor is 10 Hz (Hz) and the data collection frequency of the IMU is 100 Hz-400 Hz, between the k-th frame of lidar data and the k+1-th frame of lidar data, the electronic device can collect at least one IMU data using the IMU, k≥1, that is, the k-th frame of lidar data and the k+1-th frame of lidar data are continuous adjacent frame data.

[0037] It should be noted that when the laser radar sensor receives the kth scanning frame, that is, when the electronic device obtains the kth frame of laser radar data, the radar coordinate system corresponding to the laser radar sensor can be used k Indicates that the laser radar data is the radar coordinate system l k The data below; the IMU coordinate system corresponding to the IMU can be used k Indicates that the IMU data is the IMU coordinate system b k The following data.

[0038] In addition, the system status of the electronic device is available indicates that b k+1 The relative transformation to the world coordinate system w.

[0039] It should be noted that the execution subject involved in the embodiment of the present invention can be a positioning and global map optimization device or an electronic device. The embodiment of the present invention is further explained below by taking the electronic device as an example.

[0040] like Figure 1 FIG. 1 is a flow chart of a world-centric positioning and global map optimization method provided by the present invention, which may include:

[0041] 101. Obtain the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data.

[0042] The first frame of laser radar data and the second frame of laser radar data are adjacent frame data, the first frame of laser radar data can be represented by the kth frame of laser radar data, and the second frame of laser radar data can be represented by the k+1th frame of laser radar data;

[0043] The current global map refers to the three-dimensional point cloud map obtained by the electronic device at the current moment.

[0044] Since the data collection frequency of the IMU is greater than the data collection frequency of the LiDAR sensor, when the electronic device uses the LiDAR sensor to collect the kth frame of laser radar data and the k+1th frame of laser radar data, the electronic device can use the IMU to collect at least one IMU data.

[0045] 102. Determine an initial state estimate of the electronic device corresponding to the second frame of lidar data in the world coordinate system based on the IMU data.

[0046] The world coordinate system refers to the IMU coordinate system in which the electronic device measures the first frame of IMU data during the process of acquiring the at least one IMU data, and the world coordinate system can be represented by w;

[0047] The initial state estimate is available express.

[0048] After acquiring the IMU data, the electronic device can perform forward propagation processing on the IMU data to determine the initial state estimate corresponding to the second frame of lidar data of the electronic device in the world coordinate system w.

[0049] In some embodiments, the electronic device determines, based on the IMU data, an initial state estimate corresponding to a second frame of lidar data of the electronic device in a world coordinate system, which may include: the electronic device determines, based on the IMU data, a first kinematic model corresponding to the electronic device in a world coordinate system, a current system state, and a current state error corresponding to the current system state; the electronic device determines, based on the first kinematic model, the current system state, and the current state error, a second kinematic model corresponding to the current state error; the electronic device determines, based on the second kinematic model, the initial state estimate corresponding to the second frame of lidar data.

[0050] After acquiring the IMU data, the electronic device can process the IMU data to obtain the first kinematic model corresponding to the electronic device in the world coordinate system w and the current system state x t and the current system status x t The corresponding current state error The current state error Defined in the current system state x t The corresponding estimated state Then, the electronic device is based on the first kinematic model and the current system state x t and the current state error Determine the current state error The corresponding second kinematic model is used to determine the initial state estimate corresponding to the k+1th frame of laser radar data.

[0051] Optionally, the electronic device determines the first kinematic model corresponding to the electronic device in the world coordinate system, the current system state, and the current state error corresponding to the current system state based on the IMU data, which may include: the electronic device determines the first kinematic model corresponding to the electronic device in the world coordinate system based on the first formula; the electronic device determines the current system state based on the second formula; the electronic device determines the current state error corresponding to the current system state based on the third formula.

[0052] Among them, the first formula is;

[0053] Represents the IMU coordinate system b at time tk The position relative to the world coordinate system w, Indicates location The corresponding derivative; Indicates the speed corresponding to the IMU at time t, Indicates speed The corresponding derivative; Represents the IMU coordinate system b at time t k Rotation relative to the world coordinate system w; Indicates the acceleration collected by the accelerometer; Indicates the bias corresponding to the accelerometer; n a represents the Gaussian white noise corresponding to the accelerometer when collecting data; g w It represents the gravitational acceleration in the world coordinate system w. represents the acceleration due to gravity g w The corresponding derivative; Indicates rotation The corresponding derivative; represents the antisymmetric operator; Indicates the angular velocity collected by the gyroscope; Indicates the bias corresponding to the gyroscope; n ω Indicates the Gaussian white noise corresponding to the gyroscope when collecting data; Indicates the bias corresponding to the gyroscope The corresponding derivative; n bω Indicates bias The corresponding Gaussian white noise; Indicates the bias corresponding to the accelerometer The corresponding derivative; n ba Indicates bias The corresponding Gaussian white noise. In other words, IMU data can include: angular velocity and acceleration The first kinematic model may include: position The corresponding derivative speed The corresponding derivative Gravitational acceleration g w The corresponding derivative Rotation The corresponding derivative Bias The corresponding derivative and bias The corresponding derivative wait.

[0054] The second formula is

[0055] x tIndicates the current system status; Including rotation speed and location The combined parameters of these three state variables. In other words, the current system state x t Can include: Rotation speed Location Bias Bias and gravitational acceleration g w wait.

[0056] The third formula is

[0057]

[0058] Indicates the current system status x t The corresponding current state error, current state error is an 18-dimensional random vector, the current state error The covariance of is represents a real number; Indicates the current system status x t The corresponding estimated state; Represents the subtraction defined on the Lie group, which is used to calculate the current system state x t With estimated status The difference between Indicates rotation With estimated rotation The corresponding angular error is Represents the estimated rotation The corresponding transposed matrix; Indicates speed The corresponding estimated speed The corresponding speed error; Indicates location The corresponding estimated position The corresponding position error; Indicates bias The corresponding estimated bias; Indicates bias The corresponding estimated bias; represents the acceleration due to gravity g w The corresponding estimated gravitational acceleration; Represents the estimated bias The corresponding bias error; Represents the estimated bias The corresponding bias error; Represents the estimated gravitational acceleration The corresponding gravity acceleration error; Indicates the combination parameters The corresponding estimated parameters The corresponding inverse matrix.

[0059] Then, the electronic device combines the first formula, the second formula and the third formula to accurately obtain the current state error The corresponding second kinematic model can be expressed by the fourth formula.

[0060] Among them, the fourth formula is

[0061] represents the second kinematic model; F t represents the error state transfer matrix at time t; G t Represents the Jacobian matrix corresponding to the noise at time t; represents the white noise vector, represents Gaussian white noise n ω The corresponding transposed matrix is, represents Gaussian white noise n a The corresponding transposed matrix is, represents Gaussian white noise n bω The corresponding transposed matrix is, represents Gaussian white noise n ba The corresponding transposed matrix.

[0062] Optionally, the error state transfer matrix

[0063]

[0064] Jacobian matrix corresponding to the noise

[0065] in, Indicates rotation The corresponding estimated rotation; Indicates speed The corresponding estimated speed; Indicates location The corresponding estimated position.

[0066] Optionally, the electronic device determines the initial state estimation value corresponding to the second frame of laser radar data according to the second kinematic model, which may include: the electronic device obtains the initial state estimation value corresponding to the second frame of IMU data b k The relative position and posture between the laser radar data frame and the current global map; the electronic device determines the initial state estimation value corresponding to the second frame of laser radar data according to the second kinematic model and the relative position and posture.

[0067] Among them, the relative pose can be used express.

[0068] After the electronic device obtains the second kinematic model, it can solve the differential equation corresponding to the fourth formula to obtain the current state error Then, the electronic device uses the transfer equation to convert the relative posture The current state error calculated by the inertial measurement unit IMU data obtained in step 101 Get the initial state estimate corresponding to the arrival of the k+1th frame of lidar data

[0069] In addition, the electronic device can also obtain the covariance corresponding to the arrival of the k+1th frame of laser radar data

[0070] 103. Determine an equivalent prior distribution corresponding to a final state estimation error in a world coordinate system based on an initial state estimation value, and determine a measurement residual constraint in a world coordinate system based on a first feature point corresponding to the second lidar data.

[0071] Among them, feature points are three-dimensional point cloud data, which can be divided into line features and surface features;

[0072] Any first feature point in the k+1th frame of lidar data can be used express.

[0073] The electronic device obtains the initial state estimate And the first feature point Afterwards, according to the initial state estimate The final estimated error of the state in the world coordinate system w can be accurately determined The corresponding equivalent prior distribution; according to the first feature point The measurement residual constraints can be accurately determined.

[0074] It should be noted that there is no limit to the timing of the electronic device obtaining the equivalent prior distribution and obtaining the measurement residual constraint.

[0075] In some embodiments, the electronic device determines the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system based on the initial state estimation value, which may include: the electronic device determines the real system state corresponding to the electronic device in the world coordinate system and the estimated state error corresponding to the estimated system state based on the initial state estimation value; the electronic device determines the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system based on the real system state and the estimated state error.

[0076] The electronic device obtains the initial state estimate And the first feature point After that, in the world-centered invariant extended Kalman filter (EKF), what needs to be solved is the IMU coordinate system b k+1 relative transformation to the world coordinate system w, that is, the electronic device estimates the value according to the initial state The actual system state corresponding to the electronic device world coordinate system w can be determined and estimate the system status The corresponding estimated state error The electronic device then and estimated state error Accurately determine the final state estimation error in the world coordinate system w The corresponding equivalent prior distribution.

[0077] Among them, the invariant EKF is a highly efficient recursive filter (autoregressive filter).

[0078] Optionally, the electronic device determines the real system state corresponding to the electronic device in the world coordinate system and the estimated state error corresponding to the estimated system state based on the initial state estimation value, which may include: the electronic device determines the real system state corresponding to the electronic device in the world coordinate system according to the fifth formula; the electronic device determines the estimated state error corresponding to the estimated system state according to the sixth formula.

[0079] Among them, the fifth formula is

[0080]

[0081] Represents the real system status; Including rotation speed and location The combined parameters of these three state variables. In other words, the real system state Can include: Rotation speed Location Bias Bias and gravitational acceleration g w wait.

[0082] The sixth formula is

[0083] Represents the estimated system state The corresponding estimated state error; Represents the initial value of the frame-map matching obtained by the IMU after forward propagation of the final state estimate of the previous frame; Represents subtraction defined on Lie groups, used to calculate the real system state With initial value The difference between .

[0084] Electronic devices can accurately determine the true system state based on the fifth formula The electronic device can accurately determine the estimated state error according to the sixth formula

[0085] In some embodiments, the electronic device determines the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system based on the real system state and the estimated state error, which may include: the electronic device determines the maximum a posteriori probability estimate corresponding to the real system state based on the real system state and the prior estimate; the electronic device iteratively processes the maximum a posteriori probability estimate to obtain the final state estimation error; the electronic device determines the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system based on the estimated state error.

[0086] In order to facilitate subsequent calculations, x k+1 Replace the real system status Will Instead of estimating the state error Based on this, the electronic device is in the real system state x before fusing the k+1th frame of lidar data. k+1 A priori estimate is added So as to achieve the real system state x k+1 The purpose of forward propagation is to then transmit the electronic device according to the real system state x k+1 and a priori estimates The real system state x can be accurately determined k+1 The corresponding maximum a posteriori probability estimate Then the final state estimation error is accurately obtained and the final state estimation error The corresponding equivalent prior distribution.

[0087] Optionally, the electronic device determines the maximum a posteriori probability estimate corresponding to the real system state based on the real system state and the prior estimate, which may include: the electronic device determines the Gaussian distribution corresponding to the real system state based on the seventh formula; the electronic device determines the maximum a posteriori probability estimate corresponding to the real system state based on the Gaussian distribution and the second frame of lidar data.

[0088] Among them, the seventh formula is

[0089] Represents the real system state x k+1 The corresponding a priori estimate; Represents the estimated system state error The corresponding Gaussian distribution; Represents the estimated system state The corresponding covariance.

[0090] After the electronic device uses the seventh formula to accurately determine the Gaussian distribution, it can obtain the real system state x based on the Gaussian distribution and the k+1th frame of laser radar data. k+1 The corresponding posterior probability; then, the electronic device maximizes this posterior probability and can accurately obtain the true system state x k+1 The corresponding maximum a posteriori probability estimate is available express.

[0091] Optionally, the electronic device iteratively processes the maximum a posteriori probability estimate to obtain a final state estimation error, which may include: the electronic device determines, according to the eighth formula, a final state estimation error corresponding to the true system state.

[0092] Among them, the eighth formula is

[0093] Represents the maximum a posteriori probability estimate The corresponding final state estimation error; represents the subtraction defined on the Lie group, which is used to calculate the real system state x k+1 and the maximum a posteriori probability estimate The difference between .

[0094] The electronic device can accurately determine the maximum a posteriori probability estimate according to the eighth formula: The corresponding final state estimation error

[0095] Optionally, the electronic device determines the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system based on the estimated state error, which may include: the electronic device projects the final state estimation error on the tangent space corresponding to the maximum a posteriori probability estimate to obtain the ninth formula; the electronic device obtains the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system based on the ninth formula.

[0096] Among them, the ninth formula is

[0097] represents the subtraction defined on the Lie group, which is used to calculate the real system state x k+1 With prior estimates The difference between Represents addition defined on Lie groups, used to calculate the maximum a posteriori probability estimate and the final state estimation error The sum of J k+1 Represents the error in estimating the final state The Jacobian matrix obtained by differentiation;

[0098] Equivalent prior distributions are available express, Denotes the Jacobian matrix J k+1 The corresponding inverse matrix is, Denotes the Jacobian matrix J k+1 The corresponding inverse transpose matrix.

[0099] The electronic device estimates the error based on the final state Projection on the maximum a posteriori probability estimate On the corresponding tangent space, the ninth formula can be accurately obtained, and then the final state estimation error can be accurately obtained The corresponding equivalent prior distribution.

[0100] In some embodiments, the electronic device determines the measurement residual constraint in the world coordinate system based on the first feature point corresponding to the second laser radar data, which may include: the electronic device converts the first feature point corresponding to the second laser radar data to the world coordinate system to obtain the second feature point; the electronic device establishes a first residual function corresponding to the second feature point to the edge and a second residual function corresponding to the second feature to the surface; the electronic device determines the measurement residual constraint based on the first residual function and the second residual function.

[0101] In order to ensure the consistency of each first feature point, the electronic device will first convert the first feature point corresponding to the second lidar data to the world coordinate system to obtain the second feature point. Then, the electronic device will construct a point-to-edge or point-to-surface metric function based on the second feature point, and then accurately determine the measurement residual constraint in the world coordinate system w.

[0102] Optionally, the electronic device converts the first feature point corresponding to the second laser radar data into the world coordinate system to obtain the second feature point, which may include: the electronic device determines the second feature point according to the tenth formula.

[0103] Among them, the tenth formula is

[0104] represents the second feature point in the world coordinate system w; Indicates the IMU coordinate system b k Rotation estimate relative to the world coordinate system w; Represents the radar coordinate system l k Relative to the IMU coordinate system b k Rotation of Represents the radar coordinate system l k The second characteristic point below; Represents the radar coordinate system l k Relative to the IMU coordinate system b k location; Indicates the IMU coordinate system b k The position estimate relative to the world coordinate system w.

[0105] Based on this, the first residual function is

[0106] The second residual function is

[0107] Indicates the second feature point in the current global map The surrounding point set refers to the surrounding point set with the second feature point The electronic device needs to determine the surrounding point set. The corresponding covariance matrix M, when it is determined that the corresponding eigenvalue of the covariance matrix M is greater than other eigenvalues, indicates that the surrounding point set All the feature points in lie on a line, and the direction of this line can be determined by the eigenvector λ associated with the maximum eigenvalue. mx Indicates that the position of the line can be obtained by the surrounding point set The corresponding geometric center p c express;

[0108] Indicates the first sideline; Indicates the second sideline; Represents a set of surrounding points The normal vector μ fitted to all feature points in i The transposed matrix of i Represents a set of surrounding points The plane fitted by all feature points in to the second feature point The distance between.

[0109] According to the tenth formula, the electronic device can accurately determine the second feature point in the world coordinate system w.

[0110] Optional, electronic equipment available Indicates the second feature point.

[0111] in, Indicates the second feature point The corresponding truth value; n iIndicates measuring the second feature point The corresponding Gaussian white noise.

[0112] In some embodiments, the electronic device determines the measurement residual constraint based on the first residual function and the second residual function, which may include: the electronic device linearizes the first residual function to obtain a first target residual function; the electronic device linearizes the second residual function to obtain a second target residual function; the electronic device determines the measurement residual constraint based on the first target residual function and the second target residual function.

[0113] Among them, the first objective residual function is

[0114]

[0115] The second objective residual function is

[0116]

[0117] Represents the residual with respect to the maximum a posteriori probability estimate The first Jacobian matrix of ei Represents the residual about the second feature point The first Jacobian matrix of ; express Represents the residual with respect to the maximum a posteriori probability estimate The second Jacobian matrix of pi Represents the residual about the second feature point The second Jacobian matrix of

[0118] The first objective residual function and the second objective residual function obtained by the electronic device are easier to be combined with the equivalent prior distribution to effectively obtain the measurement residual constraint, and then obtain the final state estimation error. The maximum a posteriori probability estimation problem is solved by the electronic device through an iterative Kalman filtering method.

[0119] 104. According to the equivalent prior distribution and the measurement residual constraint, determine the current posture corresponding to the electronic device, update the current global map, and obtain the target global map.

[0120] Among them, the current posture refers to the current position information and current rotation information corresponding to the electronic device;

[0121] The target global map is a three-dimensional point cloud map.

[0122] In some embodiments, the electronic device determines the current posture corresponding to the electronic device based on the equivalent prior distribution and the measurement residual constraint, and updates the current global map to obtain the target global map, which may include: the electronic device determines the target system state update group corresponding to the second frame of lidar data based on the equivalent prior distribution and the measurement residual constraint; the electronic device uses the target system state update group to determine the current posture corresponding to the electronic device, and updates the coordinates of the current global map in the world coordinate system to obtain the target global map.

[0123] Among them, the target system status update group is

[0124]

[0125]

[0126]

[0127] represents the new state estimation error;

[0128] Represents the new state estimate, that is, the current posture of the electronic device;

[0129] represents the new covariance;

[0130] represents the Jacobian matrix group;

[0131]

[0132] Represents the second feature point The covariance of

[0133] K=(H T R -1 H+P -1 ) -1 H T R -1 , represents the Kalman gain matrix;

[0134] represents the measurement residual constraint group; I represents the identity matrix;

[0135]

[0136] When the electronic device determines that the target system state update group has converged, it can obtain a new state estimate and the new covariance Then, the electronic device estimates based on the new state and the new covariance The current position and posture corresponding to the electronic device is determined, and all coordinates of the current global map in the world coordinate system w are updated to obtain the target global map.

[0137] like Figure 2 , which is a schematic diagram of a scenario of a world-centric positioning and global map optimization method provided by the present invention. Figure 2 In the invention, the electronic device includes a feature extraction module and a lidar-inertial mapping module.

[0138] The electronic device inputs the laser radar data obtained by scanning with the laser radar sensor into the feature extraction module; then, the line features and surface features corresponding to the laser radar data are determined; then, in the laser radar-inertial mapping module, the electronic device uses the line features, the surface features and the IMU data after forward propagation processing to obtain the feature association between the current frame and the map through the frame-to-map matching method; then, when the electronic device determines that the feature association converges using the invariant extended Kalman filter state estimator, the state estimator outputs a real-time map-refined odometer (Map-refined Odometry), that is, outputs a real-time new state estimation. That is, the current position and posture corresponding to the electronic device is obtained, and at the same time, the current global map can be updated to obtain a target global map with higher accuracy.

[0139] The frame-to-map matching method refers to the data matching between the k+1th frame of lidar data and the current global map, and the initial state estimate is obtained

[0140] Optionally, after step 104, the method may further include: the electronic device outputting the target global map.

[0141] So that users can obtain the global map of the target in a timely manner.

[0142] In an embodiment of the present invention, the current global map and the inertial measurement unit IMU data in the time period corresponding to the first frame laser radar data and the second frame laser radar data are obtained; according to the IMU data, the initial state estimation value corresponding to the second frame laser radar data of the electronic device in the world coordinate system is determined; according to the initial state estimation value, the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system is determined, and according to the first feature point corresponding to the second laser radar data, the measurement residual constraint in the world coordinate system is determined; according to the equivalent prior distribution and the measurement residual constraint, the current posture corresponding to the electronic device is determined, and the current global map is updated to obtain the target global map. This method is used to solve the defect that the existing global map construction method has certain limitations, resulting in the target global map finally obtained by the robot is not accurate enough, and the equivalent prior distribution and measurement residual constraint corresponding to the final state estimation error in the world coordinate system are used to effectively and accurately update the current global map corresponding to the current environment where the electronic device is located, thereby obtaining a target global map with higher accuracy. In addition, the electronic device can also accurately obtain the current posture in the current environment where the electronic device is located, that is, obtain a positioning result with higher accuracy.

[0143] The positioning and global map optimization device provided by the present invention is described below. The positioning and global map optimization device described below and the world-centric positioning and global map optimization method described above can be referenced to each other.

[0144] like Figure 3 FIG. 1 is a schematic diagram of the structure of the positioning and global map optimization device provided by the present invention, which may include:

[0145] An acquisition module 301 is used to acquire the current global map and the inertial measurement unit IMU data within a time period corresponding to the first frame of laser radar data and the second frame of laser radar data, where the first frame of laser radar data and the second frame of laser radar data are adjacent frame data;

[0146] The processing module 302 is used to determine, based on the IMU data, an initial state estimate corresponding to the second frame of lidar data in a world coordinate system; determine, based on the initial state estimate, an equivalent prior distribution corresponding to a final state estimate error in the world coordinate system, and determine, based on the first feature point corresponding to the second lidar data, a measurement residual constraint in the world coordinate system; determine, based on the equivalent prior distribution and the measurement residual constraint, a current posture corresponding to the electronic device, and update the current global map to obtain a target global map.

[0147] Optionally, the processing module 302 is specifically used to determine, based on the IMU data, a first kinematic model corresponding to the electronic device in the world coordinate system, a current system state, and a current state error corresponding to the current system state; based on the first kinematic model, the current system state, and the current state error, determine a second kinematic model corresponding to the current state error; based on the second kinematic model, determine an initial state estimate corresponding to the second frame of lidar data.

[0148] Optionally, the processing module 302 is specifically used to determine, based on the initial state estimate, a real system state corresponding to the electronic device in the world coordinate system and an estimated state error corresponding to the estimated system state; and to determine, based on the real system state and the estimated state error, an equivalent prior distribution corresponding to the final state estimation error in the world coordinate system.

[0149] Optionally, the processing module 302 is specifically used to determine the maximum a posteriori probability estimate corresponding to the true system state based on the true system state and the prior estimate; iteratively process the maximum a posteriori probability estimate to obtain a final state estimation error; and determine, based on the estimated state error, an equivalent prior distribution corresponding to the final state estimation error in the world coordinate system.

[0150] Optionally, the processing module 302 is specifically used to convert the first feature point corresponding to the second lidar data to the world coordinate system to obtain a second feature point; establish a first residual function corresponding to the second feature point to the edge and a second residual function corresponding to the second feature to the surface; and determine the measurement residual constraint based on the first residual function and the second residual function.

[0151] Optionally, the processing module 302 is specifically used to linearize the first residual function to obtain a first target residual function; linearize the second residual function to obtain a second target residual function; and determine the measurement residual constraint based on the first target residual function and the second target residual function.

[0152] Optionally, the processing module 302 is specifically used to determine the target system state update group corresponding to the second frame of lidar data based on the equivalent prior distribution and the measurement residual constraint; use the target system state update group to determine the current posture corresponding to the electronic device, and update the coordinates of the current global map in the world coordinate system to obtain the target global map.

[0153] like Figure 4As shown, it is a schematic diagram of the structure of the electronic device provided by the present invention, and the electronic device may include: a processor (processor) 410, a communication interface (Communications Interface) 420, a memory (memory) 430 and a communication bus 440, wherein the processor 410, the communication interface 420, and the memory 430 communicate with each other through the communication bus 440. The processor 410 can call the logic instructions in the memory 430 to execute a world-centric positioning and global map optimization method, which includes: obtaining the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data, the first frame of laser radar data and the second frame of laser radar data being adjacent frame data; determining, based on the IMU data, an initial state estimate of the electronic device corresponding to the second frame of laser radar data in the world coordinate system; determining, based on the initial state estimate, an equivalent prior distribution corresponding to the final state estimation error in the world coordinate system, and determining, based on the first feature point corresponding to the second laser radar data, a measurement residual constraint in the world coordinate system; determining, based on the equivalent prior distribution and the measurement residual constraint, a current posture corresponding to the electronic device, and updating the current global map to obtain a target global map.

[0154] In addition, the logic instructions in the above-mentioned memory 430 can be implemented in the form of a software functional unit and can be stored in a computer-readable storage medium when it is sold or used as an independent product. Based on such an understanding, the technical solution of the present invention is essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM), random access memory (RAM), disk or optical disk and other media that can store program codes.

[0155] On the other hand, the present invention also provides a computer program product, which includes a computer program. The computer program can be stored on a non-transitory computer-readable storage medium. When the computer program is executed by a processor, the computer can execute the world-centric positioning and global map optimization method provided by the above methods. The method includes: obtaining the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data, and the first frame of laser radar data and the second frame of laser radar data are adjacent frame data; according to the IMU data, determining the initial state estimate of the electronic device corresponding to the second frame of laser radar data in the world coordinate system; according to the initial state estimate, determining the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system, and according to the first feature point corresponding to the second laser radar data, determining the measurement residual constraint in the world coordinate system; according to the equivalent prior distribution and the measurement residual constraint, determining the current posture corresponding to the electronic device, and updating the current global map to obtain the target global map.

[0156] On the other hand, the present invention also provides a non-transitory computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, is implemented to execute the world-centric positioning and global map optimization method provided by the above-mentioned methods, the method comprising: obtaining a current global map and inertial measurement unit IMU data within a time period corresponding to a first frame of laser radar data and a second frame of laser radar data, the first frame of laser radar data and the second frame of laser radar data being adjacent frame data; determining an initial state estimate of the electronic device corresponding to the second frame of laser radar data in a world coordinate system based on the IMU data; determining an equivalent prior distribution corresponding to a final state estimation error in the world coordinate system based on the initial state estimate, and determining a measurement residual constraint in the world coordinate system based on a first feature point corresponding to the second laser radar data; determining a current posture corresponding to the electronic device based on the equivalent prior distribution and the measurement residual constraint, and updating the current global map to obtain a target global map.

[0157] The device embodiments described above are merely illustrative, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. Ordinary technicians in this field can understand and implement it without paying creative labor.

[0158] Through the description of the above implementation methods, those skilled in the art can clearly understand that each implementation method can be implemented by means of software plus a necessary general hardware platform, and of course, it can also be implemented by hardware. Based on this understanding, the above technical solution is essentially or the part that contributes to the prior art can be embodied in the form of a software product, and the computer software product can be stored in a computer-readable storage medium, such as ROM / RAM, a disk, an optical disk, etc., including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to execute the methods described in each embodiment or some parts of the embodiments.

[0159] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. A world-centric positioning and global map optimization method, characterized in that: include: Acquire the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data, where the first frame of laser radar data and the second frame of laser radar data are adjacent frame data; Determine, according to the IMU data, an initial state estimation value of the electronic device corresponding to the second frame of laser radar data in a world coordinate system; Determine, according to the initial state estimate, an equivalent prior distribution corresponding to the final state estimate error in the world coordinate system, and determine, according to the first feature point corresponding to the second frame of lidar data, a measurement residual constraint corresponding to the second frame of lidar data in the world coordinate system; Determine a current posture corresponding to the electronic device according to the equivalent prior distribution and the measurement residual constraint, and update the current global map to obtain a target global map; The step of determining the current posture corresponding to the electronic device according to the equivalent prior distribution and the measurement residual constraint, and updating the current global map to obtain a target global map includes: Determine a target system state update group corresponding to the second frame of laser radar data according to the equivalent prior distribution and the measurement residual constraint; Using the target system state update group, determine the current posture corresponding to the electronic device, and update the coordinates of the current global map in the world coordinate system to obtain a target global map; The target system status update group is: represents the new state estimation error; represents subtraction defined on Lie groups; represents addition defined on Lie groups; Represents the new state estimate, that is, the current posture of the electronic device; represents the new covariance; represents the Jacobian matrix group; Represents the second feature point Covariance of K = (H T R -1 H+P -1 ) -1 H T R -1 , represents the Kalman gain matrix; represents the measurement residual constraint group; I represents the identity matrix; When the target system state update group is determined to converge, a new state estimate can be obtained. and the new covariance Based on the new state estimate and the new covariance Determine the current position and posture of the electronic device, and update all coordinates of the current global map in the world coordinate system w to obtain the target global map; The first feature point is three-dimensional point cloud data, and the first feature point includes a line feature and a surface feature; The equivalent prior distribution corresponding to the final state estimation error is expressed as: Denotes the Jacobian matrix J k+1 The corresponding inverse matrix is, Denotes the Jacobian matrix J k+1 The corresponding inverse transpose matrix is, represents the final state estimation error, represents a Gaussian distribution, Represents the estimated system state The corresponding covariance.

2. The method according to claim 1, characterized in that Determining, according to the IMU data, an initial state estimation value of the electronic device corresponding to the second frame of laser radar data in a world coordinate system includes: Determine, according to the IMU data, a first kinematic model corresponding to the electronic device in a world coordinate system, a current system state, and a current state error corresponding to the current system state; Determine a second kinematic model corresponding to the current state error according to the first kinematic model, the current system state and the current state error; Determine, according to the second kinematic model, an initial state estimate corresponding to the second frame of laser radar data; The electronic device determines the first motion model corresponding to the electronic device in the world coordinate system according to the first formula; determines the current system state according to the second formula; determines the current state error corresponding to the current system state according to the third formula; combines the first formula, the second formula and the third formula to determine the second kinematic model corresponding to the current state error; obtains the IMU data b of the current frame k The relative position and posture between the current global map; according to the second kinematic model, determine the transfer equation corresponding to the current state error, and based on the transfer equation, the relative position and posture and the inertial measurement unit IMU data, determine the initial state estimate corresponding to the second frame of lidar data; The first formula is: Represents the IMU coordinate system b at time t k The position relative to the world coordinate system w, Indicates location The corresponding derivative; Indicates the speed corresponding to the IMU at time t, Indicates speed The corresponding derivative; Represents the IMU coordinate system b at time t k Rotation relative to the world coordinate system w; Indicates the acceleration collected by the accelerometer; Indicates the bias corresponding to the accelerometer; n a represents the Gaussian white noise corresponding to the accelerometer when collecting data; g w It represents the gravitational acceleration in the world coordinate system w. represents the acceleration due to gravity g w The corresponding derivative; Indicates rotation The corresponding derivative; represents the antisymmetric operator; Indicates the angular velocity collected by the gyroscope; Indicates the bias corresponding to the gyroscope; n ω Represents the Gaussian white noise corresponding to the gyroscope when collecting data; Indicates the bias corresponding to the gyroscope The corresponding derivative; n bω Indicates bias The corresponding Gaussian white noise; Indicates the bias corresponding to the accelerometer The corresponding derivative; n ba Indicates bias Corresponding Gaussian white noise; IMU data includes: angular velocity and acceleration The first kinematic model includes: position The corresponding derivative speed The corresponding derivative Gravitational acceleration g w The corresponding derivative Rotation The corresponding derivative Bias The corresponding derivative and bias The corresponding derivative The second formula is x t Indicates the current system status; Including rotation speed and location The combined parameters of these three state variables; The third formula is: Indicates the current system status x t The corresponding current state error; Indicates the current system status x t The corresponding estimated state; Represents the subtraction defined on the Lie group, which is used to calculate the current system state x t With estimated status The difference between Indicates rotation With estimated rotation The corresponding angular error is Represents the estimated rotation The corresponding transposed matrix; Indicates speed The corresponding estimated speed The corresponding speed error; Indicates location The corresponding estimated position The corresponding position error; Indicates bias The corresponding estimated bias; Indicates bias The corresponding estimated bias; represents the acceleration due to gravity g w The corresponding estimated gravitational acceleration; Represents the estimated bias The corresponding bias error; Represents the estimated bias The corresponding bias error; Represents the estimated gravitational acceleration The corresponding gravity acceleration error; Indicates the combination parameters The corresponding estimated parameters The corresponding inverse matrix; The second kinematic model is represents the second kinematic model; F t represents the error state transfer matrix at time t; G t Represents the Jacobian matrix corresponding to the noise at time t; represents the white noise vector, represents Gaussian white noise n ω The corresponding transposed matrix is, represents Gaussian white noise n a The corresponding transposed matrix is, represents Gaussian white noise n bω The corresponding transposed matrix is, represents Gaussian white noise n ba The corresponding transposed matrix; The error state transfer matrix is: Jacobian matrix corresponding to the noise in, Indicates rotation The corresponding estimated rotation; Indicates speed The corresponding estimated speed; Indicates location The corresponding estimated position.

3. The method according to claim 1, characterized in that Determining, according to the initial state estimation value, an equivalent prior distribution corresponding to the final state estimation error in the world coordinate system includes: Determine, according to the initial state estimation value, a real system state corresponding to the electronic device in the world coordinate system and an estimated state error corresponding to the estimated system state; Determine, according to the real system state and the estimated state error, an equivalent prior distribution corresponding to the final state estimation error in the world coordinate system; The electronic device determines the real system state corresponding to the electronic device in the world coordinate system according to the fifth formula; determines the estimated state error corresponding to the estimated system state according to the sixth formula; determines the Gaussian distribution corresponding to the real system state according to the seventh formula; determines the maximum a posteriori probability estimate corresponding to the real system state according to the Gaussian distribution and the second frame of laser radar data; determines the final state estimation error corresponding to the maximum a posteriori probability estimate according to the eighth formula; The fifth formula is Represents the real system status; Including rotation speed and location The combined parameters of these three state variables, the real system state Includes: Rotation speed Location Bias Bias and gravitational acceleration g w ; The sixth formula is Represents the estimated system state The corresponding estimated state error; Represents the initial value of the frame-map matching obtained by the IMU after forward propagation of the final state estimate of the previous frame; Represents subtraction defined on Lie groups, used to calculate the real system state With initial value The difference between The seventh formula is Represents the real system state x k+1 The corresponding a priori estimate; Represents the estimated system state error The corresponding Gaussian distribution; Represents the estimated system state The corresponding covariance; The eighth formula is Represents the maximum a posteriori probability estimate The corresponding final state estimation error; represents the subtraction defined on the Lie group, which is used to calculate the real system state x k+1 and the maximum a posteriori probability estimate The difference between .

4. The method according to claim 3, characterized in that The determining, according to the real system state and the estimated state error, an equivalent prior distribution corresponding to the final state estimation error in the world coordinate system comprises: Determining a maximum a posteriori probability estimate corresponding to the true system state according to the true system state and the prior estimate; Iteratively processing the maximum a posteriori probability estimate to obtain a final state estimation error; Determine, according to the final state estimation error, an equivalent prior distribution corresponding to the final state estimation error in the world coordinate system; The final state estimation error is projected onto the tangent space corresponding to the maximum a posteriori probability estimate to obtain the ninth formula; according to the ninth formula, the equivalent prior distribution corresponding to the final state estimation error in the world coordinate system is obtained; The ninth formula is represents the subtraction defined on the Lie group, which is used to calculate the real system state x k+1 With prior estimates The difference between Represents addition defined on Lie groups, used to calculate the maximum a posteriori probability estimate and the final state estimation error The sum of J k+1 Represents the error in estimating the final state The Jacobian matrix obtained by taking the derivative.

5. The method according to claim 1, characterized in that The determining, according to the first feature point corresponding to the second frame of laser radar data, the measurement residual constraint in the world coordinate system includes: Convert the first feature point corresponding to the second frame of laser radar data into the world coordinate system to obtain a second feature point; Establishing a first residual function corresponding to the second feature point to the edge and a second residual function corresponding to the second feature point to the surface; A measurement residual constraint is determined according to the first residual function and the second residual function.

6. The method according to claim 5, characterized in that The determining of the measurement residual constraint according to the first residual function and the second residual function includes: Linearizing the first residual function to obtain a first target residual function; Linearizing the second residual function to obtain a second target residual function; A measurement residual constraint is determined according to the first objective residual function and the second objective residual function.

7. A device for implementing the world-centric positioning and global map optimization method according to any one of claims 1 to 6, characterized in that: include: An acquisition module, used to acquire the current global map and the inertial measurement unit IMU data within the time period corresponding to the first frame of laser radar data and the second frame of laser radar data, wherein the first frame of laser radar data and the second frame of laser radar data are adjacent frame data; A processing module is used to determine, based on the IMU data, an initial state estimate of the electronic device corresponding to the second frame of lidar data in a world coordinate system; determine, based on the initial state estimate, an equivalent prior distribution corresponding to a final state estimate error in the world coordinate system, and determine, based on a first feature point corresponding to the second frame of lidar data, a measurement residual constraint in the world coordinate system; determine, based on the equivalent prior distribution and the measurement residual constraint, a current posture corresponding to the electronic device, and update the current global map to obtain a target global map.

8. An electronic device comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein: When the processor executes the program, the world-centric positioning and global map optimization method as described in any one of claims 1 to 6 is implemented.

9. A non-transitory computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the world-centric positioning and global map optimization method as described in any one of claims 1 to 6 is implemented.