A positioning method for a vehicle-mounted integrated navigation system and a vehicle-mounted integrated navigation device
By using the loose combination method to correct the error of the inertial navigation system after the GNSS signal is restored, and switch to the tight combination method after the error correction is completed, dynamically adjusting the weight, the problems of error accumulation and positioning accuracy of the inertial navigation system are solved, and the on-board vehicle is realized High-precision positioning of combined navigation system.
Patent Information
- Application Number
- CN202210108243.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-01-28
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2042-01-28
AI Technical Summary
In the GNSS denial environment, the error of the inertial navigation system gradually accumulates over time, and the satellite signal is weak or there are multipaths in the combined mode after signal recovery, resulting in slow correction speed of cumulative errors and affecting positioning accuracy.
After detecting the recovery of the satellite signal, the positioning operation is performed using the loose combination method, and the error of the inertial navigation system is corrected by the satellite signal. When the error correction is completed, the weight of the satellite navigation system and the inertial navigation system are dynamically adjusted. To quickly correct errors.
Effectively reduce the positioning error of the vehicle-mounted combined navigation system, ensure the accuracy and stability of positioning, especially quickly correct the cumulative error after the GNSS signal is restored, and improve positioning performance.
Smart Images

Figure CN114509799B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present application relate to the field of vehicle-mounted integrated navigation, and in particular to a positioning method for a vehicle-mounted integrated navigation system and a vehicle-mounted integrated navigation device. Background Art
[0002] An inertial navigation system (INS) is a navigation system that uses accelerometers and gyroscopes to measure the acceleration and angular velocity of an object, and uses computers to continuously estimate the position, attitude, and velocity of a moving carrier. On this basis, the vehicle carrier can easily provide odometer data (Odometre, ODO). Based on the low-cost inertial navigation system, the positioning error gradually diverges over time in scenes such as tunnels and basements, while the Global Navigation Satellite System (GNSS) can provide accurate position, velocity, and time information. Therefore, the GNSS / INS / ODO combined navigation system has gradually developed.
[0003] The fusion of satellite navigation system and inertial navigation system can be divided into tight integration, loose integration and deep integration. In the GNSS denial environment, the inertial navigation system is working independently. After the GNSS signal is restored, how to manage the fusion mode of satellite navigation system and inertial navigation system in the vehicle-mounted integrated navigation system is an urgent problem to be solved. Summary of the invention
[0004] In order to solve any of the above technical problems, the embodiments of the present application provide a positioning method for a vehicle-mounted integrated navigation system and a vehicle-mounted integrated navigation device.
[0005] In order to achieve the purpose of the embodiment of the present application, the embodiment of the present application provides a positioning method of a vehicle-mounted integrated navigation system, including:
[0006] If the satellite navigation system is in a denied environment, after detecting that the satellite signal of the satellite navigation system is restored, controlling the vehicle-mounted integrated navigation system to perform positioning operation in a loose combination mode;
[0007] After detecting that the loose combination mode completes the correction of the positioning error of the inertial navigation system, the vehicle-mounted integrated navigation system is controlled to perform the positioning operation in a tight combination mode.
[0008] A storage medium stores a computer program, wherein the computer program is configured to execute the method described above when running.
[0009] 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.
[0010] One of the above technical solutions has the following advantages or beneficial effects:
[0011] When the satellite navigation system is in a denied state, the error of the inertial navigation system gradually accumulates with the working time. After the satellite signal is restored, a loose combination method is first adopted to correct the accumulated error using the satellite signal. After detecting that the loose combination method has completed the correction of the positioning error of the inertial navigation system, the vehicle-mounted combined navigation system is controlled to use a tight combination method for positioning operations, which can effectively reduce the positioning error of the vehicle-mounted combined navigation system and ensure the accuracy of positioning.
[0012] 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
[0013] 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.
[0014] Figure 1 A flowchart of a positioning method for a vehicle-mounted integrated navigation system provided in an embodiment of the present application;
[0015] Figure 2 Another flow chart of the positioning method of the vehicle-mounted integrated navigation system provided in an embodiment of the present application;
[0016] FIG3( a ) is a schematic diagram showing a comparison between a navigation trajectory determined by a method provided in an embodiment of the present application and a reference trajectory;
[0017] FIG3( b ) is a schematic diagram showing a comparison between a navigation trajectory determined by a conventional method and a reference trajectory;
[0018] FIG4( a ) is a schematic diagram of a position error curve corresponding to the method provided in an embodiment of the present application;
[0019] FIG4( b ) is a schematic diagram of a position error curve corresponding to the transmission method. DETAILED DESCRIPTION
[0020] In order to make the purpose, technical solution and advantages of the embodiments of the present application more clear, the embodiments of the present application will be described in detail in conjunction with the accompanying drawings. It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other arbitrarily.
[0021] In the process of implementing this application, it was found that the following problems exist in the related technology, including:
[0022] When the satellite navigation system is in a denied state, the error of the inertial navigation system gradually accumulates with the working time. After the satellite signal is restored, in the tight combination mode, if the satellite signal is weak or there is multipath, and the position information of the inertial navigation system is used to screen the satellite measurement values, the satellite navigation system has few measurement values and low weights, and the accumulated error correction speed is slow.
[0023] Based on the above analysis, the present application provides the following solutions, including:
[0024] Figure 1 This is a flow chart of a positioning method for a vehicle-mounted integrated navigation system provided in an embodiment of the present application. Figure 1 As shown, the vehicle-mounted integrated navigation system is provided with a satellite navigation system and an inertial navigation system, and the method comprises:
[0025] Step 101: If the satellite navigation system is in a denied environment, after detecting that the satellite signal of the satellite navigation system is restored, controlling the vehicle-mounted integrated navigation system to perform positioning operation in a loose combination mode;
[0026] Among them, in the loose combination, the satellite navigation system and the inertial navigation system work independently, and finally the data of the two are merged to correct the relevant parameters of the inertial navigation system. The positioning operation of the satellite navigation system is less affected by the inertial navigation system; in the tight combination, the positioning operation of the satellite navigation system does not have independent positioning, and the original satellite positioning information, such as pseudorange, pseudorange rate, etc., is directly merged with the inertial navigation system, and the two work together.
[0027] In this step, after detecting that the satellite signal of the satellite navigation system has been restored, since the error of the inertial navigation system gradually accumulates with the working time, the relevant parameters of the inertial navigation system are corrected using a loose combination method to achieve the purpose of reducing the positioning error of the inertial navigation system, thereby effectively controlling the error of the vehicle-mounted combined navigation system.
[0028] Step 102: after detecting that the loose combination mode completes the correction of the positioning error of the inertial navigation system, controlling the vehicle-mounted integrated navigation system to perform positioning operation in a tight combination mode;
[0029] By adopting the loose combination method to correct the positioning error of the inertial navigation system, the positioning error of the vehicle-mounted integrated navigation system is significantly reduced. Then, the tight combination method is used for positioning operations, which can effectively ensure the accuracy of positioning.
[0030] The method provided in the embodiment of the present application is that when the satellite navigation system is in a denied state, the error of the inertial navigation system gradually accumulates with the working time. After the satellite signal is restored, a loose combination method is first adopted to correct the accumulated error using the satellite signal. After detecting that the loose combination method has completed the correction of the positioning error of the inertial navigation system, the vehicle-mounted combined navigation system is controlled to use a tight combination method for positioning operations, which can effectively reduce the positioning error of the vehicle-mounted combined navigation system and ensure the accuracy of positioning.
[0031] The method provided in the embodiment of the present application is described below:
[0032] In an exemplary embodiment, the inertial navigation system completes the correction of the positioning error by the following method, including:
[0033] Calculate the positioning error between the combined positioning result determined by the vehicle-mounted integrated navigation system using loose combination and the positioning result determined independently by the satellite navigation system;
[0034] If the positioning error meets a preset error condition, it is determined that the inertial navigation system completes the correction of the positioning error.
[0035] When the positioning error between the loose combination filtering result and the positioning result of the satellite navigation system meets the preset error condition, it means that the inertial navigation system in the loose combination mode has completed the correction of relevant parameters, so that the gap between the combined positioning result determined by the loose combination and the positioning result determined by the satellite positioning system is small. Therefore, the loose combination filtering can be switched to the tight combination filtering.
[0036] In an exemplary embodiment, after detecting that the satellite signal of the satellite navigation system is restored, the method further includes:
[0037] Obtain information on the working status of the inertial navigation system in a satellite navigation system denied environment;
[0038] Determining, according to the working status information, whether the current positioning accuracy of the inertial navigation system meets a preset accuracy threshold;
[0039] If the accuracy threshold is met, the vehicle-borne integrated navigation system is directly controlled to perform positioning operation in a tight combination mode; otherwise, the vehicle-borne integrated navigation system is controlled to perform positioning operation in a loose combination mode.
[0040] The working status information includes at least one of the duration of independent working, the distance of independent working and the number of vehicle turns during the distance.
[0041] Specifically, when a vehicle carrier is traveling in a denied environment, it mainly relies on inertial navigation for recursion. If the driving distance in the denied environment is short, there are fewer turns, and the inertial navigation system works independently for a short time, the vehicle-mounted combined navigation system can maintain a good positioning accuracy. After the GNSS signal is restored, the GNSS measurement value can directly participate in the tight combination filtering estimation; if the driving distance in the denied environment is long, there are more turns, and the inertial navigation system works independently for a long time, the positioning accuracy of the vehicle-mounted combined navigation system has been degraded. After the GNSS signal is restored, if the GNSS measurement value directly participates in the tight combination filtering solution, the result of the combined navigation will be affected by the inertial navigation system. Therefore, the vehicle-mounted combined navigation system is first controlled to use a loose combination method for positioning operations to reduce the influence of the inertial navigation system on the positioning results of the combined navigation system.
[0042] Further, if the accuracy threshold is not met, controlling the satellite navigation system to independently locate, and respectively obtaining a first positioning result of the satellite navigation system and a second positioning result of the inertial navigation system in the same epoch;
[0043] Calculating a position deviation between the first positioning result and the second positioning result;
[0044] If the position deviation is within the preset deviation range, the vehicle-mounted integrated navigation system is controlled to perform positioning operation in a loose combination mode; otherwise, the first positioning result is output as the positioning result of the vehicle-mounted integrated navigation system.
[0045] When the accuracy threshold is not met, the weight of the inertial navigation system is relatively large, and the fusion positioning error cannot be corrected quickly. Independent positioning based on satellite measurement values can eliminate the influence of the inertial navigation system. Therefore, controlling the satellite navigation system to perform independent positioning and positioning based on the measurement values of the satellite navigation system can obtain independent positioning results that are no longer affected by the inertial navigation system, thereby ensuring the accuracy of the positioning results.
[0046] Furthermore, the integrated navigation system integrates the positioning results of the satellite navigation system and the positioning results of the inertial navigation system. According to the positioning error, satellite signal quality and the working quality of the inertial navigation system, they are divided into the following two categories:
[0047] (1) If the position deviation between the positioning result of the satellite navigation system and the positioning result of the inertial navigation system is greater than the threshold, the position of the inertial navigation system is no longer trusted, and the PVT positioning result is directly output as the combined positioning result;
[0048] (2) If the error between the satellite positioning result and the inertial navigation system positioning result is less than the threshold, loose combination filtering is performed and the loose combination filtering result is used as the combined positioning result.
[0049] In an exemplary embodiment, the number of times the first positioning result is continuously output as the combined positioning result is recorded; after the recorded number reaches a preset threshold, the parameters of the inertial navigation system are initialized using the first positioning result.
[0050] If the first positioning result is output as the combined positioning result for multiple consecutive times, it means that there are large deviations in the relevant parameters of the inertial navigation system and the correction cannot be completed in a short time. Therefore, the initial position is reset according to the positioning result of the satellite navigation system to ensure that the inertial navigation system resumes normal operation as soon as possible.
[0051] In an exemplary embodiment, the controlling the vehicle-mounted integrated navigation system to perform positioning operation in a loose combination manner includes:
[0052] Adjusting the first weight corresponding to the satellite navigation system and the second weight corresponding to the inertial navigation system in the loose combination mode;
[0053] The positioning operation is performed in a loose combination manner using the adjusted first weight and second weight.
[0054] When the accuracy threshold is not met, the weight corresponding to the inertial navigation system is larger. When the loose combination method is used for positioning, the positioning results of the two are appropriately weighted, which can effectively ensure the accuracy of the loose combination positioning results.
[0055] In an exemplary embodiment, the adjusting the first weight corresponding to the satellite navigation system and the second weight corresponding to the inertial navigation system in the loose combination mode includes:
[0056] Determining an adjustment range of a first weight corresponding to the satellite navigation system according to the positioning accuracy of the inertial navigation system;
[0057] According to the adjustment range of the first weight, the values of the first weight and the second weight are adjusted.
[0058] According to the positioning accuracy of the inertial navigation system, the adjustment range of the first weight corresponding to the satellite navigation system is determined, wherein the worse the positioning accuracy of the inertial navigation system is, the greater the value of the first weight increase is, and the corresponding adjustment range is larger. The above-mentioned adjustment method can effectively ensure the accuracy of the weight adjustment.
[0059] Furthermore, through at least two adjustment operations, the value change of the first weight is controlled to reach the adjustment range.
[0060] The value of the first weight may be changed to reach the adjustment range through multiple adjustments, so as to ensure that the value of the first weight gradually increases and ensure a smooth transition of the combined positioning operation in the loose combination mode.
[0061] The adjustment range of each adjustment of the first weight is determined by the following method, including:
[0062] Get the signal quality of satellite signals;
[0063] An adjustment amplitude of the first weight within the adjustment range is determined according to the signal quality.
[0064] The better the signal quality of the satellite signal, the larger the value of each adjustment amplitude; conversely, the smaller the signal quality of the satellite signal, the smaller the value of each adjustment amplitude. Determining the adjustment amplitude of the first weight based on the above method can effectively ensure the accuracy of the combined positioning operation of the loose combination method.
[0065] For example, the working status of the inertial navigation system can be judged in the following three categories:
[0066] (1) If the inertial navigation system is in a very poor working state, the positioning weight of the satellite navigation positioning result P1 is increased step by step according to the satellite signal quality of the satellite navigation system. If the current satellite signal quality is m>m0, the weight is set to w0; if the satellite signal quality is m0≥m>m1, the weight is set to w1; if the satellite signal quality is m1≥m>m2, the weight is set to w2; if the satellite signal quality is m<m0, the weight is set to w3, where the increase in each stage is a1;
[0067] (2) If the inertial navigation system is in poor working condition, the positioning weight of the satellite navigation positioning result P1 is increased in small steps according to the satellite signal quality of the satellite navigation system. If the current satellite signal quality is m>m0, the weight is set to w4; if the satellite signal quality is m0≥m>m1, the weight is set to w5; if the satellite signal quality is m1≥m>m2, the weight is set to w6; if the satellite signal quality is m<m0, the weight is set to w7, where the increase in each stage is a2;
[0068] (3) If the inertial navigation system is in normal working condition, the positioning result is set in stages according to the satellite signal quality of the satellite navigation system to improve the positioning weight of the satellite navigation positioning result P1. The current satellite signal quality is m>m0, and the weight is set to w8. The satellite signal quality is m0≥m>m1, and the weight is set to w9. The satellite signal quality is m1≥m>m2, and the weight is set to w 10 , satellite signal quality m<m0, set weight w 11 , where the increase in each stage is a3;
[0069] Among them, m0~m2 represent different signal quality thresholds;
[0070] w0~w 10 is the fusion weight of the satellite navigation system positioning result in loose combination, where the larger the weight number, the smaller the value;
[0071] a1~a3 are the amplitudes of increase in each stage of the fusion weight of the satellite navigation system positioning result in loose combination, where the larger the amplitude number, the smaller the value.
[0072] The method provided in the embodiment of the present application is described below with a specific application example:
[0073] Based on the low-cost GNSS / IMU / ODO vehicle-mounted integrated navigation system, after the GNSS signal environment is restored from the GNSS denial environment, the inertial navigation system has slow cumulative error correction and inaccurate positioning trajectory. In order to solve the above technical problems, the embodiments of the present application provide the following solutions, including:
[0074] Figure 2 Another flow chart of the positioning method of the vehicle-mounted integrated navigation system provided in the embodiment of the present application. Figure 2 As shown, the vehicle-mounted integrated navigation system is provided with a satellite navigation system and an inertial navigation system, and the method comprises:
[0075] Step 201, detecting GNSS signal recovery;
[0076] Step 202: determining the current positioning performance of the inertial navigation system;
[0077] If the current performance is credible, step 203 is executed.
[0078] If the current performance is not credible, then execute steps 204 to 209;
[0079] Step 203, continue to perform tight combination filtering, and then execute step 210;
[0080] Step 204, exit the tight combination filtering;
[0081] Step 205: Control the satellite navigation system to independently perform positioning according to the GNSS measurement value;
[0082] Step 206: determine whether the positioning difference between the satellite navigation system and the inertial navigation system meets the threshold;
[0083] The threshold is set to P0, the current positioning result of the satellite navigation system is obtained as P1, and the current positioning result of the inertial navigation system is obtained as P2;
[0084] If |P1-P2|≥P0, then execute step 207 and no longer trust the inertial navigation system result P2; otherwise, trust the inertial navigation system result P2, and then execute steps 207 to 208;
[0085] Step 207: Select the positioning result P1 of the satellite navigation system and execute.
[0086] Optionally, if the positioning result of the satellite navigation system is output multiple times in succession, the positioning result of the satellite navigation system is reassigned to the inertial navigation system as an initial value.
[0087] Step 208: Determine the working status of the inertial navigation system, which is mainly divided into the following three categories:
[0088] (1) If the inertial navigation system is in a very poor working state, the positioning weight of the satellite navigation positioning result P1 is greatly increased in stages according to the satellite signal quality of the satellite navigation system. If the current satellite signal quality is m>m0, the weight is set to w0; if the satellite signal quality is m0≥m>m1, the weight is set to w1; if the satellite signal quality is m1≥m>m2, the weight is set to w2; if the satellite signal quality is m<m0, the weight is set to w3;
[0089] (2) If the inertial navigation system is in poor working condition, the positioning weight of the satellite navigation positioning result P1 is increased in small steps according to the satellite signal quality of the satellite navigation system. If the current satellite signal quality is m>m0, the weight is set to w4; if the satellite signal quality is m0≥m>m1, the weight is set to w5; if the satellite signal quality is m1≥m>m2, the weight is set to w6; if the satellite signal quality is m<m0, the weight is set to w7;
[0090] (3) If the inertial navigation system is in normal working condition, the positioning weight of the satellite navigation positioning result P1 is set in stages according to the satellite signal quality of the satellite navigation system. If the current satellite signal quality is m>m0, the weight is set to w8; if the satellite signal quality is m0≥m>m1, the weight is set to w9; if the satellite signal quality is m1≥m>m2, the weight is set to w 10 , satellite signal quality m<m0, set weight w 11 The above m0~m2 represent different signal quality thresholds, w0~w 10 It is the fusion weight of the satellite navigation system positioning results in loose combination. The weight gradually decreases according to the number.
[0091] Step 209: After setting the weights, perform loose combination filtering and execute step 210;
[0092] Step 210: Output the positioning result and the process ends.
[0093] To summarize, compared with the traditional tightly integrated vehicle-mounted integrated navigation system, when the GNSS signal is restored, the vehicle carrier status can be evaluated, and the loose combination mode can be switched in time to allow the satellite navigation to independently locate. Different fusion weights can be dynamically selected according to the status of the satellite navigation system and the inertial navigation system, and the accumulated error of the inertial navigation system can be quickly corrected to ensure the positioning performance after the GNSS signal is restored.
[0094] FIG3(a) is a schematic diagram of a comparison between a navigation track determined by the method provided in an embodiment of the present application and a reference track. As shown in FIG3(a), the curve marked by the arrow is the reference track, and the curve without the arrow mark is the navigation track determined by the method provided in an embodiment of the present application. The vehicle loses the GNSS signal at the lower right position of the figure, and subsequently changes to a pure inertial navigation system recursion, the error gradually accumulates, and a weak GNSS signal is restored at the upper right corner, and a strong GNSS signal is restored at the lower left corner.
[0095] FIG3(b) is a schematic diagram comparing the navigation trajectory determined by the traditional method and the reference trajectory. As shown in FIG3(b), the curve marked by the arrow is the reference trajectory, and the curve without the arrow mark is the navigation trajectory determined by the method provided by the embodiment of the present application. The vehicle loses the GNSS signal at the lower right position in the figure, and then changes to a pure inertial navigation system recursion, the error gradually accumulates, and the weak GNSS signal is restored at the upper right corner, and the strong GNSS signal is restored at the lower left corner.
[0096] As can be seen from Figure 3(a) and Figure 3(b), after the weak GNSS signal is restored, the method provided by the embodiment of the present application can quickly correct the accumulated error and meet the basic navigation requirements, while the trajectory positioning error of the traditional method has not been significantly converged. After the strong GNSS signal is restored, the positioning accuracy of the new method is further improved, and the positioning error of the traditional method slowly converges. It can be seen that after the GNSS signal is restored, the new combined navigation strategy can significantly improve the positioning quality.
[0097] FIG4(a) is a schematic diagram of a position error curve corresponding to the method provided in the embodiment of the present application. FIG4(b) is a schematic diagram of a position error curve corresponding to the transmission method. By comparing FIG4(a) and FIG4(b), it can be seen that after recovering the weak GNSS signal, the position error of the new method is significantly smaller than the position error of the traditional method. Therefore, during the recovery of the weak GNSS signal, the method provided in the embodiment of the present application has obvious advantages over the traditional method.
[0098] An embodiment of the present application provides a storage medium, in which a computer program is stored, wherein the computer program is configured to execute any of the methods described above when running.
[0099] An embodiment of the present application provides a vehicle-mounted integrated navigation device, comprising a memory and a processor, wherein the memory stores a computer program, and the processor is configured to run the computer program to execute any of the methods described above.
[0100] 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 positioning method for a vehicle-mounted integrated navigation system, characterized in that: The vehicle-mounted integrated navigation system is provided with a satellite navigation system and an inertial navigation system, and the method comprises: If the satellite navigation system is in a denied environment, after detecting that the satellite signal of the satellite navigation system is restored, controlling the vehicle-mounted integrated navigation system to perform positioning operation in a loose combination mode; After detecting that the inertial navigation system has completed the correction of the positioning error, controlling the vehicle-mounted integrated navigation system to perform the positioning operation in a tight combination manner; After detecting that the satellite signal of the satellite navigation system is restored, the method further includes: Acquiring working status information of the inertial navigation system when the satellite navigation system is in a denied environment; the working status information includes at least one of the duration of independent working, the distance of independent working, and the number of vehicle turns during the distance; When it is determined according to the working status information that the current positioning accuracy of the inertial navigation system meets a preset accuracy threshold, the vehicle-mounted integrated navigation system is controlled to perform a positioning operation in a tight combination manner; when the current positioning accuracy of the inertial navigation system does not meet the preset accuracy threshold, the vehicle-mounted integrated navigation system is controlled to perform a positioning operation in a loose combination manner.
2. The method according to claim 1, characterized in that The correction of the positioning error of the inertial navigation system is determined by the following methods, including: Calculate the positioning error between the combined positioning result determined by the vehicle-mounted integrated navigation system using loose combination and the positioning result determined independently by the satellite navigation system; If the positioning error meets a preset error condition, it is determined that the inertial navigation system completes the correction of the positioning error.
3. The method according to claim 1, characterized in that: The method further comprises: If the accuracy threshold is not met, controlling the satellite navigation system to independently locate, and respectively obtaining a first positioning result of the satellite navigation system and a second positioning result of the inertial navigation system in the same epoch; Calculating a position deviation between the first positioning result and the second positioning result; If the position deviation is within a preset deviation range, the vehicle-mounted integrated navigation system is controlled to perform a positioning operation in a loose combination mode; otherwise, the first positioning result is output as a combined positioning result of the vehicle-mounted integrated navigation system.
4. The method according to claim 3, characterized in that: The method further comprises: Record the number of times the first positioning result is continuously output as the combined positioning result; After the number of records reaches a preset number threshold, the parameters of the inertial navigation system are initialized using the first positioning result.
5. The method according to claim 3, characterized in that: The controlling the vehicle-mounted integrated navigation system to perform positioning operation in a loose combination manner includes: Adjusting the first weight corresponding to the satellite navigation system and the second weight corresponding to the inertial navigation system in the loose combination mode; The positioning operation is performed in a loose combination manner using the adjusted first weight and second weight.
6. The method according to claim 5, characterized in that The adjusting of the first weight corresponding to the satellite navigation system and the second weight corresponding to the inertial navigation system in the loose combination mode includes: Determining an adjustment range of a first weight corresponding to the satellite navigation system according to the positioning accuracy of the inertial navigation system; According to the adjustment range of the first weight, the values of the first weight and the second weight are adjusted.
7. The method according to claim 6, characterized in that Through at least two adjustment operations, the value change of the first weight is controlled to reach the adjustment range.
8. The method according to claim 7, characterized in that The adjustment range of each adjustment of the first weight is determined by the following method, including: Get the signal quality of satellite signals; An adjustment amplitude of the first weight within the adjustment range is determined according to the signal quality.
9. A storage medium, characterized in that: The storage medium stores a computer program, wherein the computer program is configured to execute the method according to any one of claims 1 to 8 when executed.
10. 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 8.
Citation Information
Cited By
Cascade learning type multi-source fusion positioning method and system under satellite denial
CN120447008A
