IMU positioning management method, device and vehicle-mounted map system

By using the correction information of the on-board map system to correct the IMU positioning parameters in the on-board combined navigation system, the problem of decreasing positioning accuracy and divergence of the IMU when the GNSS signal is lost is solved, and navigation performance and accuracy are improved.

CN114279440BActive Publication Date: 2024-12-06UNICORE COMM INC
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111484576.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-07
Publication Date
2024-12-06
Estimated Expiration
2041-12-07

AI Technical Summary

Technical Problem

When the GNSS signal is lost, the positioning accuracy of the IMU positioning system decreases, especially in a long-term satellite denial environment, the divergence of the speed of the vehicle carrier leads to a significant lateral deviation of the positioning trajectory, affecting navigation performance.

Method used

By obtaining the positioning trajectory information of the on-board combined navigation system, the on-board map system is used to correct it, and the correction information is generated and sent to the IMU for correcting its positioning parameters, thereby suppressing the accumulation of IMU heading deviation and the divergence of the positioning trajectory.

Benefits of technology

It effectively improves the accuracy of IMU positioning and the positioning performance of the vehicle navigation system in the environment of satellite signal loss, reduces the lateral deviation of the positioning trajectory, extends the positioning time, and improves the positioning accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114279440B_ABST
    Figure CN114279440B_ABST
Patent Text Reader

Abstract

The embodiment of the present application discloses a management method, device and vehicle-mounted map system for IMU positioning. The method includes: sending positioning trajectory information of a vehicle-mounted integrated navigation system; obtaining correction information determined by the vehicle-mounted map system according to the positioning trajectory information; correcting the values ​​of the IMU positioning parameters using the correction information; and performing the IMU positioning operation using the corrected positioning parameters.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The embodiments of the present application relate to the field of vehicle navigation, and in particular to an IMU positioning management method, device and vehicle map system. Background Art

[0002] The vehicle-mounted integrated navigation device integrates the Global Navigation Satellite System (GNSS) and the Inertial Measurement Unit (IMU). As the urban environment becomes increasingly complex, when the vehicle is located in areas such as boulevards, tunnels or under overpasses, the GNSS is often unable to locate due to obstruction of satellite signals. The recursive error of the low-cost IMU will accumulate over time and cannot work alone for a long time, and must be constantly calibrated.

[0003] In order to maintain the positioning accuracy and improve the positioning performance of the GNSS / IMU vehicle navigation system when the satellite external observation is lost, it is necessary to train the IMU related error state when the satellite signal is available; when the satellite signal is lost, the velocity constraint auxiliary update model (Auxiliary Velocity Updates, AVUs) is used to suppress the divergence of the IMU dead reckoning. Zero Velocity Update (ZUPT) and Non-Holonomic Constraint (NHC) are two commonly used AVUs. Among them, the ZUPT technology uses the vehicle velocity value of zero in the parking situation as a constraint condition to correct the inertial navigation update speed; while the NHC technology uses the lateral and vertical velocity components of the vehicle in the straight-moving situation close to the road as zero as a constraint condition to correct the inertial navigation update speed. In addition, using the odometer derived velocity (ODV) as the velocity constraint of the forward axis to achieve three-axis complete constraints is an effective solution to further improve the positioning performance when the satellite is lost. The introduction of the odometer has improved the entire integrated navigation system in terms of constraint integrity. As a vehicle-mounted system, the odometer observations are easy to obtain and use. Whether in pulse mode or serial port input, it can provide longer-lasting and more accurate positioning effects in a GNSS-denied environment.

[0004] Although the use of ZUPT, NHC and ODV can suppress the speed divergence of vehicle carriers to a certain extent, when the vehicle carrier is in a GNSS-denied environment for a long time, such as a long tunnel, the principle of vehicle carrier maneuvering and odometer dead reckoning determines that there is no observability of the driving heading. As the heading indicated by the low-cost IMU diverges, it is inevitable that the positioning trajectory will have a large deviation in the lateral direction of the carrier, and the positioning accuracy will be significantly reduced. Summary of the invention

[0005] In order to solve any of the above technical problems, the embodiments of the present application provide an IMU positioning management method, device and vehicle map system.

[0006] In order to achieve the purpose of the embodiment of the present application, the embodiment of the present application provides a management method for IMU positioning, including:

[0007] Send positioning track information of the vehicle integrated navigation system;

[0008] Obtaining correction information determined by the vehicle-mounted map system according to the positioning trajectory information;

[0009] Correcting the values ​​of the positioning parameters of the IMU using the correction information;

[0010] Use the corrected positioning parameters to perform IMU positioning operations.

[0011] A vehicle-mounted integrated navigation device comprises a memory and a processor, wherein the memory stores a computer program, and the processor is configured to run the computer program to execute the method described above.

[0012] A management method for IMU positioning, comprising:

[0013] Obtain positioning trajectory information of the vehicle-mounted integrated navigation system;

[0014] Determine projection trajectory information obtained by projecting the positioning trajectory information in the vehicle-mounted map system;

[0015] Obtaining a deviation between the positioning trajectory information and the projection trajectory information;

[0016] Generating correction information of the IMU positioning trajectory according to the deviation;

[0017] The correction information is sent.

[0018] A vehicle-mounted map system comprises a memory and a processor, wherein the memory stores a computer program, and the processor is configured to run the computer program to execute the method described above.

[0019] One of the above technical solutions has the following advantages or beneficial effects:

[0020] The vehicle-mounted integrated navigation system obtains the correction information determined by the vehicle-mounted map system based on the positioning trajectory information to realize the correction of the IMU positioning parameters and improve the accuracy of IMU positioning.

[0021] Other features and advantages of the embodiments of the present application will be described in the subsequent description, and partly become apparent from the description, or can be understood by implementing the embodiments of the present application. The purpose and other advantages of the embodiments of the present application can be achieved and obtained by the structures specifically pointed out in the description, claims and drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0022] The accompanying drawings are used to provide further understanding of the technical solutions of the embodiments of the present application and constitute a part of the specification. Together with the embodiments of the embodiments of the present application, they are used to explain the technical solutions of the embodiments of the present application and do not constitute a limitation on the technical solutions of the embodiments of the present application.

[0023] Figure 1 A flowchart of a method for managing IMU positioning is provided for an embodiment of the present application;

[0024] Figure 2 A flowchart of another IMU positioning management method provided in an embodiment of the present application;

[0025] Figure 3 A schematic diagram of the projection of the positioning trajectory information provided in an embodiment of the present application on a map;

[0026] Figure 4 A schematic diagram of a positioning correction method for a vehicle-mounted map system provided in an embodiment of the present application;

[0027] Figure 5 This is a flowchart of a positioning correction method for a vehicle-mounted integrated navigation system provided in an embodiment of the present application. DETAILED DESCRIPTION

[0028] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the embodiments of the present application will be described in detail in conjunction with the accompanying drawings. It should be noted that the embodiments and features in the embodiments of the present application can be combined with each other arbitrarily without conflict.

[0029] In the process of implementing this application, a technical analysis of the relevant technologies was conducted and it was found that the relevant technologies have at least the following problems, including:

[0030] Figure 1 A flowchart of an IMU positioning management method provided in an embodiment of the present application. Figure 1 As shown, the method includes:

[0031] Step 101, sending positioning track information of the vehicle-mounted integrated navigation system;

[0032] Step 102: obtaining correction information determined by the vehicle-mounted map system according to the positioning trajectory information;

[0033] Step 103: Correct the values ​​of the positioning parameters of the IMU using the correction information;

[0034] Step 104: Use the corrected positioning parameters to perform an IMU positioning operation.

[0035] The above method flow is applied to a vehicle-mounted integrated navigation system.

[0036] Preferably, the positioning trajectory information may be partial positioning trajectory information within one epoch.

[0037] At the i-th epoch, the positioning trajectory generated in the i-th epoch is sent out so that before the start of the i+1-th epoch or after a period of time, the corresponding positioning management information is received and corrected in time, effectively reducing the deviation of the positioning trajectory in the i+1-th epoch, thereby improving the positioning accuracy, where i is a positive integer.

[0038] The method provided in the embodiment of the present application realizes the correction of the positioning parameters of the IMU and improves the accuracy of IMU positioning by obtaining correction information determined by the on-board map system based on the positioning trajectory information.

[0039] The method provided in the embodiment of the present application is described below:

[0040] In an exemplary embodiment, after detecting that the GNSS is in a denied state, the positioning trajectory information of the vehicle-mounted integrated navigation system is sent.

[0041] When the GNSS signal is good, the vertical projection in the on-board map system cannot fully reflect the movement of the vehicle carrier. When the GNSS signal is poor, the IMU cumulative deviation gradually increases. At this time, the map feedback information can effectively correct the gradually divergent IMU sensor deviation. Therefore, after detecting that the GNSS is in a denied state, the positioning trajectory information is sent to interact with the on-board map system. With the help of the positioning management information provided by the on-board map system, the vehicle heading can be effectively constrained, thereby avoiding the problem of positioning trajectory divergence caused by the accumulation of IMU heading deviation.

[0042] In an exemplary embodiment, the method further comprises:

[0043] Obtaining the generation time of the correction information;

[0044] Get the time difference between the current epoch information and the generated time;

[0045] If the time difference is less than a preset time threshold, the correction information is used to correct the parameters used in the IMU positioning operation.

[0046] For the vehicle integrated navigation system, the positioning track information used by the positioning management information provided by the vehicle map system is historical data, not the positioning track information of the current epoch. The delayed observation deviation information is applied to the integrated navigation system to affect the positioning of the current epoch.

[0047] Based on the above analysis, it can be seen that by obtaining the generation time of the correction information and calculating the time difference between the current epoch information and the generation time, it is possible to determine whether the time difference is within the time delay range that the on-board integrated navigation system can receive, so as to avoid the delay time of the correction information being too long affecting the timing of the entire system update and the positioning output.

[0048] In an exemplary embodiment, the method further comprises:

[0049] Obtaining the type of road on which the vehicle is traveling as determined by the in-vehicle map system;

[0050] Determining whether the road type meets a preset road determination condition;

[0051] If the road type meets the road judgment condition, the correction information is used to correct the parameters used for the IMU positioning operation.

[0052] Taking advantage of the ability of the on-board map system to accurately determine the road type, the road type determined by the on-board map system is obtained to determine whether GNSS denial will occur, so as to determine whether to use the correction information provided by the on-board map to limit the correction method to specific road types, for example, only in long tunnels.

[0053] In an exemplary embodiment, the method further comprises:

[0054] Obtaining a probability value of the vehicle-mounted map system correctly identifying the road information on which the vehicle is traveling;

[0055] If the probability value is greater than a preset probability threshold, the correction information is used to correct the parameters used in the IMU positioning operation.

[0056] Since the positioning track information provided to the vehicle map system may be biased, the vehicle map system may match multiple road information based on the positioning track information. When matching multiple roads, the correction information determined by the vehicle map system based on the correctly matched roads is correct, and the use of the correct correction information can effectively compensate for the deviations in the positioning operation of the current epoch; conversely, the correction information determined based on the incorrectly matched roads is incorrect, and the use of incorrect correction information cannot compensate for the deviations in the positioning operation of the current epoch, and may even deteriorate the positioning results of the current epoch.

[0057] Obtaining the probability value of correct road identification from the vehicle-mounted map system and determining appropriate correction information according to the probability value can reduce the probability of using incorrect correction information and increase the probability of successful correction.

[0058] For the vehicle-mounted integrated navigation system, the correction information fed back by the vehicle-mounted map system has a feedforward effect. Since the introduction of the correction information, the positioning of each future epoch and the corresponding map feedback information will be affected by the observation of the starting point. Therefore, the above text is based on time information, road type, and accurate probability values ​​of road recognition to constrain the scope of the correction information and eliminate the impact of the introduction of bad information on subsequent positioning.

[0059] In an exemplary embodiment, the correction information includes at least one of heading information, east deviation and north deviation.

[0060] When the vehicle carrier is in a GNSS denial environment for a long time, the on-board integrated navigation system cannot observe the heading. Therefore, the heading information of the IMU is corrected using the heading provided by the on-board map system. In addition, the divergence of the heading indicated by the IMU will cause a large deviation in the positioning trajectory in the lateral direction of the carrier. The east deviation and north deviation can be used to constrain the vehicle heading, thereby avoiding the problem of positioning trajectory divergence caused by the accumulation of IMU heading deviations.

[0061] In an exemplary embodiment, the correction information further includes weight information of the deviation amount;

[0062] Using the correction information to correct the values ​​of the positioning parameters of the IMU includes:

[0063] Obtaining the satellite lock-out duration and / or vehicle driving information in the vehicle-mounted integrated navigation system;

[0064] adjusting the weight of the deviation amount in the correction information according to the unlocking duration and / or the driving information;

[0065] The adjusted deviation weight is used to correct the value of the IMU positioning parameter.

[0066] Taking the satellite signal lock-out time as an example, the longer the satellite signal lock-out time is, the greater the weight of the deviation in the map correction information is, and vice versa.

[0067] By dynamically adjusting the weight of the deviation, the rational use of the deviation can be guaranteed, and the rationality and accuracy of the correction operation can be guaranteed.

[0068] Figure 2 A flowchart of another IMU positioning management method provided in an embodiment of the present application. Figure 2 As shown, the method includes:

[0069] Step 201, obtaining positioning track information of the vehicle-mounted integrated navigation system;

[0070] Step 202: determining projection trajectory information obtained by projecting the positioning trajectory information in the vehicle-mounted map system;

[0071] Step 203: obtaining a deviation between the positioning trajectory information and the projection trajectory information;

[0072] Step 204: generating correction information of the IMU positioning trajectory according to the deviation;

[0073] Step 205: Send the correction information.

[0074] The above method flow is applied to the in-vehicle map system, and the in-vehicle map system can be implemented by setting a map APP on the vehicle.

[0075] The method provided in the embodiment of the present application realizes the correction of the positioning parameters of the IMU by providing correction information to the IMU, thereby improving the accuracy of IMU positioning.

[0076] In an exemplary embodiment, determining the projection trajectory information obtained by projecting the positioning trajectory information in the vehicle-mounted map system includes:

[0077] Identifying the road information on which the vehicle is traveling from the map data according to the positioning trajectory information;

[0078] The positioning trajectory information is projected onto the road information to obtain new positioning trajectory information.

[0079] Figure 3 This is a schematic diagram of the projection of the positioning trajectory information provided in the embodiment of the present application on the map. Figure 3 As shown, the positioning track of the vehicle integrated navigation system is A1~A3;

[0080] The on-board map system projects the positioning trajectories A1-A3 vertically to trajectories B1-B3 at the center of the road.

[0081] The vehicle map system calculates the deviation A between the two i B i , where i=1,2,3.

[0082] The method provided in the embodiment of the present application is described below:

[0083] Figure 4 Schematic diagram of the positioning correction method of the vehicle map system provided in the embodiment of the present application. Figure 4As shown in the figure, after the vehicle-mounted integrated navigation system completes positioning, the relevant navigation status is transmitted to the map end. The map determines the offset between the relevant integrated navigation positioning position and the actual road by matching projection, and then forms map feedback data in combination with relevant road information and transmits it to the integrated navigation system. In the next positioning epoch, the integrated navigation will update and estimate the IMU-related error state based on the map feedback data, thereby obtaining a navigation positioning state with higher accuracy. The map feedback data may include:

[0084] (1)T map --Matching information time base;

[0085] (2) Type - Match the road type;

[0086] (3) P--matching road probability;

[0087] (4) Yaw--matching road heading;

[0088] (5) dE, dN – the easting and northing deviations between the matching road projection point and the actual positioning result.

[0089] Figure 5 This is a flow chart of a positioning correction method for a vehicle-mounted integrated navigation system provided in an embodiment of the present application. Figure 5 As shown, based on the above feedback data, the processing flow of the vehicle integrated navigation system is as follows:

[0090] Step A01: First, determine whether the currently received map feedback data is based on the positioning of the previous epoch by matching the time T, so as to determine whether the delay time ΔT meets the set threshold ΔT. th ;

[0091] ΔT=TT map <ΔT th ;

[0092] If the preset threshold ΔT is met th , then execute step A01; otherwise, the process ends.

[0093] Step A02: judging whether the correction information can be used according to the road type Type;

[0094] The road type judgment is used to limit the scope of the correction information to be used only in long tunnels;

[0095] Because when the satellite signal is good, the vertical projection cannot fully reflect the movement behavior of the vehicle carrier, and in a long tunnel, the IMU cumulative deviation gradually increases. At this time, the correction information fed back by the map can effectively correct the gradually divergent IMU sensor deviation.

[0096] If the correction information can be used, step A02 is executed; otherwise, the process ends.

[0097] Step A03: Select the correction information to be used this time according to the matching probability P;

[0098] The correction information with the largest probability value may be selected, or the correction information may be selected only when the matching probability is greater than a preset value, for example, the value is 90%;

[0099] If the correction information is selected, step A04 is executed; otherwise, the process ends.

[0100] Step A04: dynamically adjust the offset weight of the map matching indication according to the satellite lock-out time of the integrated navigation system and the driving maneuvering conditions, and estimate the IMU-related error state using Yaw and dE, dN as constraint observations.

[0101] In order to solve the problem of gradual divergence of the lateral deviation of the positioning trajectory of a low-cost GNSS / IMU vehicle-mounted combined navigation system in a long-term satellite loss environment, the present invention takes into account that the vehicle can conveniently provide map data, and the map manufacturer will perform map matching based on the positioning results of the combined navigation. The difference between the matched positioning result and the combined navigation positioning result can effectively constrain the vehicle heading, thereby avoiding the problem of positioning trajectory divergence caused by the accumulation of IMU heading deviation.

[0102] To sum up, compared with the existing vehicle-mounted integrated navigation system, the method provided in the embodiment of the present application, by introducing map feedback data and establishing constrained observation, can effectively improve the lateral deviation of the positioning of the vehicle-mounted integrated navigation system and improve the positioning accuracy in a satellite denial environment.

[0103] The embodiment of the present application provides a vehicle-mounted integrated navigation device, including a memory and a processor, wherein a computer program is stored in the memory, and the processor is configured to run the computer program to execute Figure 1 The method described in .

[0104] The embodiment of the present application provides a vehicle-mounted map system, including a memory and a processor, wherein a computer program is stored in the memory, and the processor is configured to run the computer program to execute Figure 2 The method described in .

[0105] It will be appreciated by those skilled in the art that all or some of the steps, systems, and functional modules / units in the methods disclosed above may be implemented as software, firmware, hardware, and appropriate combinations thereof. In hardware implementations, the division between the functional modules / units mentioned in the above description does not necessarily correspond to the division of physical components; for example, a physical component may have multiple functions, or a function or step may be performed by several physical components in cooperation. Some or all components may be implemented as software executed by a processor, such as a digital signal processor or a microprocessor, or implemented as hardware, or implemented as an integrated circuit, such as an application-specific integrated circuit. Such software may be distributed on a computer-readable medium, which may include a computer storage medium (or non-transitory medium) and a communication medium (or temporary medium). As known to those skilled in the art, the term computer storage medium includes volatile and non-volatile, removable and non-removable media implemented in any method or technology for storing information (such as computer-readable instructions, data structures, program modules, or other data). Computer storage media include, but are not limited to, RAM, ROM, EEPROM, flash memory or other memory technology, CD-ROM, digital versatile disks (DVD) or other optical disk storage, magnetic cassettes, magnetic tapes, magnetic disk storage or other magnetic storage devices, or any other medium that can be used to store the desired information and can be accessed by a computer. In addition, it is well known to those of ordinary skill in the art that communication media typically contain computer-readable instructions, data structures, program modules, or other data in a modulated data signal such as a carrier wave or other transport mechanism, and may include any information delivery media.

Claims

1. A management method for IMU positioning, characterized in that: include: Send positioning track information of the vehicle integrated navigation system; Obtaining correction information determined by the vehicle-mounted map system according to the positioning trajectory information; Correcting the values ​​of the positioning parameters of the IMU using the correction information; Use the corrected positioning parameters to perform IMU positioning operations; Wherein, the correction information includes weight information of the deviation; using the correction information to correct the values ​​of the IMU's positioning parameters, including: obtaining at least one of the satellite's lock-out duration and the vehicle's driving information in the vehicle-mounted combined navigation system; adjusting the weight of the deviation in the correction information according to at least one of the lock-out duration and the driving information; and using the adjusted weight of the deviation to correct the values ​​of the IMU's positioning parameters.

2. The method according to claim 1, characterized in that: After detecting that the GNSS is in a denied state, the positioning trajectory information of the vehicle-mounted integrated navigation system is sent.

3. The method according to claim 1, characterized in that The method further comprises: Obtaining the generation time of the correction information; Get the time difference between the current epoch information and the generated time; If the time difference is less than a preset time threshold, the correction information is used to correct the parameters used in the IMU positioning operation.

4. The method according to claim 1, characterized in that: The method further comprises: Obtaining the type of road on which the vehicle is traveling as determined by the in-vehicle map system; Determining whether the road type meets a preset road determination condition; If the road type meets the road judgment condition, the correction information is used to correct the parameters used for the IMU positioning operation.

5. The method according to claim 1, characterized in that: The method further comprises: Obtaining a probability value of the vehicle-mounted map system correctly identifying the road information on which the vehicle is traveling; If the probability value is greater than a preset probability threshold, the correction information is used to correct the parameters used in the IMU positioning operation.

6. The method according to any one of claims 1 to 5, characterized in that: The correction information includes at least one of heading information, east deviation and north deviation.

7. A management method for IMU positioning, characterized in that: include: Obtain positioning trajectory information of the vehicle-mounted integrated navigation system; Determine projection trajectory information obtained by projecting the positioning trajectory information in the vehicle-mounted map system; Obtaining a deviation between the positioning trajectory information and the projection trajectory information; Generating correction information of the IMU positioning trajectory according to the deviation; sending the correction information; Wherein, the correction information includes weight information of the deviation; the correction information is used to correct the values ​​of the positioning parameters of the IMU, including: obtaining at least one of the satellite loss lock duration and the vehicle driving information in the vehicle-mounted combined navigation system; adjusting the weight of the deviation in the correction information according to at least one of the loss lock duration and the driving information; and using the adjusted deviation weight to correct the values ​​of the IMU positioning parameters.

8. The method according to claim 7, characterized in that The determining of the projection trajectory information obtained by projecting the positioning trajectory information in the vehicle-mounted map system includes: Identifying the road information on which the vehicle is traveling from the map data according to the positioning trajectory information; The positioning trajectory information is projected onto the road information to obtain new positioning trajectory information.

9. A vehicle-mounted integrated navigation device, comprising a memory and a processor, characterized in that: A computer program is stored in the memory, and the processor is configured to run the computer program to perform the method according to any one of claims 1 to 6.

10. A vehicle map system, comprising a memory and a processor, characterized in that: A computer program is stored in the memory, and the processor is configured to run the computer program to perform the method of claim 7 or 8.