Baseline solution and IMU data fusion method and device, medium and program product

Through the fusion method of baseline solution and IMU data, the Kalman filter and carrier phase smoothness screening technology are used to solve the problems of baseline solution and IMU data error in navigation positioning, and the accuracy and stability of heading angle estimation are improved. Adapt to different environmental changes.

CN119043336APending Publication Date: 2024-11-29XIAMEN XINNUO TECH
View PDF 0 Cites 4 Cited by

Patent Information

Application Number
CN202411377250.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-30
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

In the existing navigation and positioning technology, baseline solution is difficult to reflect dynamic changes in real time, while IMU data has a reduced long-term accuracy due to error accumulation, resulting in insufficient heading angle estimation accuracy and stability.

Method used

The fusion method of baseline solution and IMU data is adopted, and the Kalman filter fusion of single epoch baseline solution and IMU module data is combined with carrier phase smoothness screening and loose combination technology to dynamically adjust the observed noise covariance and improve heading angle Real-time and accuracy of estimation.

Benefits of technology

While maintaining real-time, the accuracy and stability of heading angle estimation are improved, the characteristics and environmental changes of different data sources are adapted to the cumulative error of the IMU module is reduced, and the reliability and accuracy of the system are enhanced.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119043336A_ABST
    Figure CN119043336A_ABST
Patent Text Reader

Abstract

The invention provides a baseline solution and IMU data fusion method and device, a medium and a program product, and the method comprises the steps: S1, obtaining at least a first GNSS signal and a second GNSS signal through at least two GNSS receivers disposed on a mobile device, and obtaining local IMU data through an IMU module disposed on the mobile device; s2, carrying out single-epoch baseline solution on the first GNSS signal and the second GNSS signal to obtain a baseline solution and a solution course angle; s3, the IMU module is used for carrying out integration processing on the local IMU data, course angle data measured by the IMU module are obtained, and the course angle data measured by the IMU module comprise the course angle change rate; s4, performing data fusion on the calculated course angle and course angle data measured by the IMU module based on the established Kalman filter; and step S5, extracting a course angle after fusion from the data after fusion. By means of the technical scheme, the accuracy and stability of course angle estimation can be improved on the premise that real-time performance is kept.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of navigation and positioning, and in particular to a method, device, medium and program product for baseline solution and IMU data fusion. Background Art

[0002] In the field of navigation and positioning, the Global Navigation Satellite System (GNSS) and IMU modules are widely used to provide position and orientation information to achieve high-precision heading angle estimation in applications such as autonomous driving, robot navigation, and precision agriculture. Baseline solution is a key part of GNSS data processing. It can provide high-precision position information. However, due to its dependence on satellite signals and high computational complexity, the success rate and output frequency of baseline solution are limited, and it is difficult to reflect dynamic changes in real time; IMU can output data at a high frequency and has high accuracy in a short period of time, which is very suitable for providing continuous position and orientation information. However, since the error of IMU itself will accumulate over time, especially in the absence of external information correction, its long-term accuracy will gradually decrease. In order to solve the above problems, the market generally adopts a simple fusion method of GNSS and IMU data. Although this method can make up for their respective shortcomings to a certain extent, it still has limitations in terms of accuracy and reliability. Summary of the invention

[0003] The embodiments of the present invention provide a method, device, medium and program product for baseline solution and IMU data fusion to improve the accuracy and stability of heading angle estimation while maintaining real-time performance.

[0004] In order to achieve the above object, on the one hand, a method for baseline solution and IMU data fusion is provided, the method comprising:

[0005] Step S1, obtaining at least a first GNSS signal and a second GNSS signal through at least two GNSS receivers arranged on the mobile device, and obtaining local IMU data through an IMU module arranged on the mobile device;

[0006] Step S2, performing a single epoch baseline solution on the first GNSS signal and the second GNSS signal to obtain a baseline solution and a solved heading angle;

[0007] Step S3, using the IMU module to perform integration processing on the local IMU data to obtain the heading angle data measured by the IMU module, the heading angle data measured by the IMU module including: heading angle change rate;

[0008] Step S4, performing data fusion on the solved heading angle and the heading angle data measured by the IMU module based on the established Kalman filter;

[0009] Wherein, establishing the Kalman filter comprises:

[0010] Step S41, define a first state vector x0, where:

[0011]

[0012] Where θ represents the heading angle, represents the rate of change of the heading angle θ;

[0013] Step S42, establishing observation models for the calculated heading angle and the heading angle data measured by the IMU module, respectively, wherein:

[0014] Z gnss =H gnss x0+v gnss

[0015] Z IMU =H IMU x0+v IMU

[0016] Among them, z gnss is the observation vector for calculating the heading angle, v gnss is the observation noise for calculating the heading angle, H gnss is the measurement matrix for calculating the heading angle, H gnss =[1 0],z IMU The observation vector of the heading angle data measured by the IMU module, HI MU is the observation matrix of the heading angle data measured by the IMU module, H IMU =[0 1],v IMU is the observation noise of the heading angle data measured by the IMU module, v gnss With v IMU The value of is predetermined;

[0017] Step S43, determining the value of the observation noise covariance R, where:

[0018] For the case where the observed data is the calculated heading angle, if the accuracy of the baseline solution meets the predetermined accuracy condition, the value of the observed noise covariance is Otherwise, the value of the observation noise covariance is

[0019] For the case where the observation data is the heading angle data measured by the IMU module, the value of the observation noise covariance is

[0020] in, and The values ​​of are predetermined;

[0021] Step S44, using the state transfer matrix F and process noise w to perform state prediction, where:

[0022] x pred =Fx prev +w

[0023] Among them, x prev is the first state vector at the previous moment, w is a fixed coefficient, and F is:

[0024]

[0025] Δt IMU is the data update interval of the IMU module;

[0026] Step S45, calculating the Kalman gain K, and using the K to update the first state vector and the error covariance P, where:

[0027] K=PH T (HPH T +R) -1

[0028] The first state vector is updated by the following formula:

[0029] x0=x pred +K(z-Hx pred )

[0030] Update the error covariance P by the following formula:

[0031] P=(I-KH)P

[0032] Among them, x pred is the predicted value of the first state vector, H is the corresponding observation matrix, z is the corresponding observation vector, the initial value of P is the unit matrix, and I is the unit matrix;

[0033] When the data is updated, if the data arriving is the data of the IMU module, then K is the Kalman gain K based on the IMU module data. IMU , z is the observation vector Z of the IMU module IMU If the data received is the data obtained by the single epoch baseline solution, then K is the Kalman gain K based on the single epoch baseline solution data. GNSS , z is the observation vector z for calculating the heading angle gnss ;

[0034] Step S5, extracting the fused heading angle from the updated first state vector x0.

[0035] Preferably, in the method of baseline solution and IMU data fusion, step S2 comprises:

[0036] Perform single epoch baseline solution on the first GNSS signal and the second GNSS signal to obtain the optimal solution X of the integer ambiguity to be solved 0 and the suboptimal solution X 1 , where the optimal solution X 0 The corresponding residual is The residual corresponding to the suboptimal solution X1 is Residual Ratio

[0037] According to the resolved integer ambiguity, the optimal solution baseline r is determined 0 and the suboptimal solution baseline r 1 ;

[0038] When the RT is greater than or equal to the predetermined residual threshold, the optimal solution baseline r is output. 0 , and determine the optimal solution baseline r 0 Satisfying the predetermined accuracy condition, when using the optimal solution baseline r 0 When data fusion is performed, the value of the observation noise covariance is

[0039] When the RT is less than the residual threshold, further determine ||r 1 |-|r 0 Is the value of || less than the predetermined baseline difference threshold? If so, the optimal solution baseline r is determined 0 is the reference solution r that does not meet the predetermined accuracy conditions ref , and output the reference solution r ref , using the reference solution r ref When data fusion is performed, the value of the observation noise covariance is

[0040] Preferably, in the method of baseline solution and IMU data fusion, step S2 further comprises:

[0041] The carrier phase smoothness screening method is used to select satellites for GNSS receivers to calculate positions;

[0042] The following calculations are performed for each satellite:

[0043]

[0044] in, is the satellite carrier phase received at the i-th moment, is the satellite carrier phase received at the moment before the i-th moment, is the first differential value of the satellite carrier phase at the i-th moment, is the first differential value of the satellite carrier phase at the moment before the i-th moment, is the secondary difference value of the satellite carrier phase at the i-th moment;

[0045] Choose to meet satellites to calculate the position, where Indicates the preset secondary difference threshold.

[0046] Preferably, the method for baseline solution and IMU data fusion further comprises the step of loosely combining the first GNSS signal, the second GNSS signal and the local IMU data;

[0047] Wherein, the loose combination includes:

[0048] Define the second state vector x1, where:

[0049]

[0050] Among them, P gnnss represents a GNSS position vector including latitude, longitude and altitude determined according to the first GNSS signal and the second GNSS signal, v gnss represents the GNSS speed determined according to the first GNSS signal and the second GNSS signal, q imu Represents the attitude quaternion of the IMU module, b imu Represents the zero bias estimation of the IMU module;

[0051] Establish the system state equation:

[0052] x1(k+1)=F(k)*x1(k)+G(k)*w(k)

[0053] Wherein, F(k) is a state transfer matrix, which represents the change of the second state vector between time k and k+1; G(k) is a system noise matrix, which represents the influence of system noise on the second state vector; w(k) is a system noise vector;

[0054] Establish the observation equation:

[0055] z(k)=H(k)*x1(k)+v(k)

[0056] Wherein, z(k) is an observation vector, including the observation data of the GNSS receiver and the measurement data of the IMU module; H(k) is an observation matrix; v(k) is an observation noise vector;

[0057] predicting an estimated value of the second state vector at the current moment according to the system state equation,

[0058] x pre (k+1)=F(k)*x est (k)

[0059] Among them, x pre (k+1) is the predicted value of the second state vector, x est (k) is the estimated value of the second state vector at the current moment;

[0060] Make a covariance matrix prediction, where:

[0061] P pre (k+1)=F(k)*P est (k)*F(k) T +G(k)*Q(k)*G(k) T

[0062] Among them, P pre (k+1) is the predicted covariance matrix, P est (k) is the estimated value of the covariance matrix at the current moment, and Q(k) is the covariance matrix of the system noise;

[0063] The Kalman gain is calculated based on the predicted covariance matrix and the observed noise covariance matrix:

[0064] K(k+1)=P pre (k+1)*H(k+1) T *(H(k+1)*P ore (k+1)*H(k+1) T

[0065] +R(k+1)- 1 )

[0066] Where K(k+1) represents the calculated Kalman gain, H(k+1) represents the observation matrix at the next moment after the kth moment, and R(k+1) represents the observation noise covariance matrix;

[0067] The predicted value of the second state vector is corrected according to the Kalman gain and the observation residual, wherein:

[0068] x est (k+1)=x pre (k+1)+K(k+1)*(z(k+1)-H(k+1)*x pre (k+1))

[0069] Among them, x est(k+1) represents the second state vector after correction; z(k+1) is the observation vector at the next moment of the kth moment;

[0070] The predicted covariance matrix is ​​modified according to the Kalman gain, where:

[0071] P est (k+1)=(IK(k+1)*H(k+1)*P pre (k+1))

[0072] Among them, P est (k+1) represents the modified covariance matrix, and I represents the identity matrix;

[0073] Extract the zero bias estimate b of the IMU module from the corrected second state vector imu , use the extracted zero bias estimate to correct the measurement value of the IMU module, and convert the corrected measurement value of the IMU module from quaternion to Euler angle, and the heading angle contained in the Euler angle is used for data fusion in step S4.

[0074] Preferably, in the method of baseline solution and IMU data fusion, in step S42, when the heading angle calculated by the single epoch baseline solution is used, the observation vector is:

[0075] Z gnss =[θ gnss ]

[0076] Among them, θ gnss is the solved heading angle;

[0077] When using the local IMU data, the observation vector is:

[0078] Z IMU =[△θ IMU ]

[0079] Among them, Δθ IMU is the rate of change of heading angle obtained according to the local IMU data.

[0080] Preferably, in the method of baseline solution and IMU data fusion, step S45 further comprises:

[0081] When the at least two GNSS receivers do not receive the GNSS signal, but the IMU module obtains local IMU data, the first state variable is updated using the obtained local IMU data:

[0082] x0=x pred +K IMU (z IMU-Hx pred )

[0083] When the at least two GNSS receivers receive a GNSS signal, the first state variable is updated by the GNSS signal:

[0084] x0=x pred +K GNSS (Z GNSS -Hx pred ).

[0085] On the other hand, a device for baseline solution and IMU data fusion is provided, which includes a memory and a processor, the memory stores at least one program, and the at least one program is executed by the processor to implement any of the methods for baseline solution and IMU data fusion as described above.

[0086] On the other hand, a computer-readable storage medium is provided, wherein the storage medium stores at least one program, and the at least one program is executed by a processor to implement any of the above-described methods of baseline solution and IMU data fusion.

[0087] On the other hand, a computer program product is provided, comprising a computer program, wherein when the computer program is executed by a processor, the method of baseline solution and IMU data fusion as described above is implemented.

[0088] The above technical solution has the following technical effects:

[0089] The technical solution of the embodiment of the present invention obtains high-precision position information through the single epoch baseline solution technology, and uses a customized Kalman filter model to fuse the data obtained by the single epoch baseline solution with the IMU module data. It takes into account the difference in the update frequency of GNSS data and the update frequency of IMU module data, and effectively utilizes the high-frequency output of the IMU module to compensate for the time limitations of the single epoch solution, thereby improving the accuracy and stability of heading angle estimation while maintaining real-time performance.

[0090] In a further embodiment, the observation noise covariance is dynamically adjusted according to the quality of the observation data, thereby being able to adapt to the characteristics of different data sources and environmental changes, thereby improving the quality of the fused data;

[0091] In a further embodiment, in the single epoch baseline solution, the second difference of the carrier phase is used to identify and remove unstable satellite data, and a new satellite screening method is proposed to improve the reliability of the single epoch baseline solution;

[0092] In a further embodiment, a customized loose combination method is adopted to reduce the cumulative error by correcting the zero bias estimation of the IMU, thereby improving the measurement accuracy, system stability and reliability, and improving the effect of data fusion. BRIEF DESCRIPTION OF THE DRAWINGS

[0093] Figure 1 A schematic diagram of a flow chart of a method for baseline solution and IMU data fusion according to an embodiment of the present invention;

[0094] Figure 2 A schematic diagram of a device for baseline solution and IMU data fusion according to an embodiment of the present invention. DETAILED DESCRIPTION

[0095] To further illustrate the various embodiments, the present invention provides drawings. These drawings are part of the disclosure of the present invention, which are mainly used to illustrate the embodiments and can be used in conjunction with the relevant descriptions in the specification to explain the operating principles of the embodiments. With reference to these contents, a person of ordinary skill in the art should be able to understand other possible implementations and advantages of the present invention. The components in the figures are not drawn to scale, and similar component symbols are generally used to represent similar components.

[0096] The present invention will now be further described with reference to the accompanying drawings and specific implementation methods.

[0097] Embodiment 1:

[0098] In order to effectively utilize the high-frequency output of the IMU module to compensate for the time limitation of the single epoch solution, and to improve the accuracy and stability of the heading angle estimation while maintaining real-time performance, this embodiment provides a method for fusing baseline solution with IMU data. Figure 1 FIG. 1 is a flow chart of a baseline solution and IMU data fusion method according to an embodiment of the present invention. Figure 1 As shown, the method comprises the following steps:

[0099] Step S1, obtaining at least a first GNSS signal and a second GNSS signal through at least two GNSS receivers arranged on the mobile device, and obtaining local IMU data through an IMU module arranged on the mobile device;

[0100] Step S2, performing a single epoch baseline solution on the first GNSS signal and the second GNSS signal to obtain a baseline solution and a solved heading angle;

[0101] The baseline vector is the relative position of the antennas of at least two GNSS receivers in space, and the calculated heading angle is the projection of the baseline vector on the horizontal plane of space.

[0102] In a specific implementation, a carrier phase smoothness screening method is used to select satellites for position calculation by a GNSS receiver;

[0103] The following calculations are performed for each satellite:

[0104]

[0105] in, is the satellite carrier phase received at the i-th moment, is the satellite carrier phase received at the moment before the i-th moment, is the first differential value of the satellite carrier phase at the i-th moment, is the first differential value of the satellite carrier phase at the moment before the i-th moment, is the secondary difference value of the satellite carrier phase at the i-th moment;

[0106] Choose to meet satellites to calculate the position, where Indicates the preset secondary difference threshold. Only satellites that satisfy the inequality meet the screening conditions.

[0107] Step S3, using the IMU module to perform integration processing on the local IMU data to obtain the heading angle data measured by the IMU module, the heading angle data measured by the IMU module includes: heading angle change rate;

[0108] In a specific implementation, the first GNSS signal, the second GNSS signal and the local IMU data are loosely combined, wherein:

[0109] Define the second state vector x1, where:

[0110]

[0111] P gnss represents a GNSS position vector including latitude, longitude and altitude determined according to the first GNSS signal and the second GNSS signal, v gnss represents the GNSS speed determined according to the first GNSS signal and the second GNSS signal, g imu Indicates the attitude quaternion of the IMU module, b imu Represents the zero bias estimation of the IMU module;

[0112] Establish the system state equation, which describes the time evolution of the state vector:

[0113] x1(k+1)=F(k)*x1(k)+G(k)*w(k)

[0114] F(k) is the state transfer matrix, which represents the change of the second state vector between time k and k+1; G(k) is the system noise matrix, which represents the influence of system noise on the second state vector; w(k) is the system noise vector;

[0115] Establish the observation equation, which associates the state vector and the observation data, where:

[0116] z(k)=H(k)*x1(k)+v(k)

[0117] z(k) is the observation vector, including the observation data of the GNSS receiver and the measurement data of the IMU module; H(k) is the observation matrix, which represents the relationship between the observation data and the second state vector; v(k) is the observation noise vector;

[0118] According to the system state equation, the estimated value of the second state vector at the current moment is predicted.

[0119] x pre (k+1)=F(k)*x est (k)

[0120] Among them, x pre (k+1) is the predicted value of the second state vector, x est (k) is the estimated value of the second state vector at the current moment;

[0121] Make a covariance matrix prediction, where:

[0122] P pre (k+1)=F(k)*P est (k)*F(k)T+G(k)*Q(k)*G(k) T

[0123] Among them, P pre (k+1) is the predicted covariance matrix, P est (k) is the estimated value of the covariance matrix at the current moment, Q(k) is the covariance matrix of the system noise;

[0124] The Kalman gain is calculated based on the predicted covariance matrix and the observed noise covariance matrix:

[0125] K(k+1)=P pre (k+1)*H(k+1) T *(H(k+1)*P pre (k+1)*H(k+1) T +R(k+1) -1 )

[0126] Where K(k+1) represents the calculated Kalman gain, H(k+1) represents the observation matrix at the next moment after the kth moment, and R(k+1) represents the observation noise covariance matrix;

[0127] The predicted value of the second state vector is corrected according to the Kalman gain and the observation residual, where:

[0128] x est (k+1)=x pre (k+1)+K(k+1)*(z(k+1)-H(k+1)*x pre (k+1))

[0129] Among them, x est (k+1) represents the modified second state vector; z(k+1) is the observation vector at the next moment after the kth moment;

[0130] The predicted covariance matrix is ​​modified according to the Kalman gain, where:

[0131] P est (k+1)=(IK(k+1)*H(k+1)*P ore (k+1))

[0132] Among them, P est (k+1) represents the modified covariance matrix, and I represents the identity matrix;

[0133] Extract the zero bias estimate b of the IMU module from the corrected second state vector imu , use the extracted zero bias estimate to correct the measurement value of the IMU module, and convert the corrected measurement value of the IMU module from quaternion to Euler angle, and the heading angle contained in the Euler angle is used for data fusion in step S4.

[0134] Step S4, performing data fusion on the calculated heading angle and the heading angle data measured by the IMU module based on the established Kalman filter;

[0135] Among them, establishing a Kalman filter includes:

[0136] Step S41, define a first state vector x0, where:

[0137]

[0138] Where θ represents the heading angle, represents the rate of change of the heading angle θ;

[0139] Step S42: Since the heading angle of the IMU has a fixed deviation, the absolute value of the heading angle of the IMU cannot be used directly, but the rate of change of the heading angle of the IMU should be used. Therefore, the observation vector and the observation model need to be adjusted accordingly. The observation model is established for the heading angle data measured by the IMU module and the calculated heading angle, respectively, where:

[0140] Z gnss =H gnss x0+v gnss

[0141] Z IMU =H IMU x0+v IMU

[0142] Among them, z gnss To calculate the observation vector of the heading angle, v gnss To resolve the observation noise of the heading angle, H gnss To solve the observation matrix of the heading angle, H gnss =

[10] ,Z IMU H is the observation vector of the heading angle data measured by the IMU module. IMU H is the observation matrix of the heading angle data measured by the IMU module. IMU =[0 1],v IMU is the observation noise of the heading angle data measured by the IMU module, v gnss With v IMU The value of is predetermined;

[0143] Preferably, when the heading angle calculated using a single epoch baseline solution is used, the observation vector is:

[0144] z gnss =[θ gnss ]

[0145] Among them, θ gnss is to solve the heading angle;

[0146] When using local IMU data, the observation vector is:

[0147] Z IMU =[△θ IMU ]

[0148] Among them, Δθ IMU It is the rate of change of heading angle obtained based on the local IMU data.

[0149] Step S43, the observation noise covariance is a key parameter that reflects the uncertainty of the observation data. In this embodiment, the value of R is dynamically adjusted according to the quality of the observation data. Determine the value of the observation noise covariance R, where:

[0150] For the case where the observation data is used to calculate the heading angle, if the accuracy of the baseline solution meets the predetermined accuracy condition, the value of the observation noise covariance is Otherwise, the observation noise covariance is

[0151] For the case where the observation data is the heading angle data measured by the IMU module, the value of the observation noise covariance is

[0152] in, and The values ​​of are predetermined;

[0153] Step S44, using the state transfer matrix F and process noise w to perform state prediction, where:

[0154] x pred =Fx prev +w

[0155] Among them, x prev is the first state vector at the previous moment, w is a fixed coefficient, and F is:

[0156]

[0157] Δt IMU It is the data update interval of the IMU module;

[0158] Step S45, calculate the Kalman gain K, and use K to update the first state vector and the error covariance P, where:

[0159] K=PH T (HPH T +R) -1

[0160] Update the first state vector by the following formula:

[0161] x0=x pred +K(z-Hx pred )

[0162] Update the error covariance P by the following formula:

[0163] P=(I-KH)P

[0164] Among them, x pred is the predicted value of the first state vector, H is the corresponding observation matrix, z is the corresponding observation vector, the initial value of P is the unit matrix, and I is the unit matrix;

[0165] When the data is updated, if the data arriving is from the IMU module, K is the Kalman gain K based on the IMU module data. IMU, z is the observation vector Z of the IMU module IMU ; If the data received is the data of single epoch baseline solution, then K is the Kalman gain K based on the single epoch baseline solution data GNSS , z is the observation vector z for calculating the heading angle gnss ;

[0166] Preferably, when at least two GNSS receivers do not receive GNSS signals but the IMU module acquires local IMU data, the acquired local IMU data is used to update the first state variable:

[0167] x0=x pred +K IMU (z IMU -Hx pred )

[0168] When at least two GNSS receivers receive a GNSS signal, the first state variable is updated by the GNSS signal:

[0169] x0=x pred +K GNSS (Z GNSS -Hx pred ).

[0170] Step S5, extracting the fused heading angle from the updated first state vector x0.

[0171] Embodiment 2:

[0172] Due to the high-precision but low-frequency output of the baseline solution and the high-frequency but easily accumulated errors of the IMU, there is an obvious need for fusion to give full play to the advantages of both and improve the performance of the overall navigation system.

[0173] Therefore, the technical solution of this embodiment is intended to solve the above problem, and the technical solution includes the following contents:

[0174] Data sources include: at least two GNSS receivers and one IMU module (Inertial Measurement Unit).

[0175] The method of baseline solution and IMU data fusion in this embodiment includes the following steps:

[0176] Step 1: Single epoch baseline solution

[0177] 1. Data preprocessing

[0178] (1) Data analysis

[0179] At least two GNSS receivers output RTCM3.2 statements, and the output statements are parsed to obtain satellite ephemeris, pseudorange, carrier phase, signal-to-noise ratio, Doppler shift and other data corresponding to different GNSS receivers;

[0180] (2) Satellite position calculation

[0181] The satellite ephemeris can be used to calculate the real-time position (x, y, z) of the satellite, where:

[0182]

[0183] x, y, z represent the position of the satellite in the rectangular coordinate system of space, xk, yk, zk are the positions of the satellite at the time of launch, i.e. the kth moment, calculated based on the satellite motion trajectory, w is the angular velocity of the earth's rotation, and t is the satellite signal propagation time.

[0184] (3) Satellite screening

[0185] In addition to using conventional methods such as signal-to-noise ratio, elevation angle, and geometric sparsity index to screen satellites, this embodiment uses carrier phase smoothness to screen satellites and performs the following calculation for each satellite:

[0186]

[0187] in, is the satellite carrier phase received at the i-th moment, is the satellite carrier phase received at the i-th moment before the moment, is the first differential value of the satellite carrier phase at the i-th moment, is the first differential value of the satellite carrier phase at the previous moment, is the secondary difference value of the satellite carrier phase at the i-th moment;

[0188] Choose to meet satellites to calculate the position, where Indicates the preset secondary difference threshold. Only satellites that satisfy the inequality meet the screening conditions.

[0189] (4) Carrier phase difference

[0190] The satellites received by two GNSS receivers within a very short distance have almost the same satellite clock error, tropospheric delay and ionospheric delay, so differential calculation between GNSS receivers can eliminate the above errors. Differential calculation between satellites can eliminate the clock error of GNSS receivers. The carrier phase differential formula is established based on the satellites that meet the secondary differential threshold, where:

[0191]

[0192] in, represents the carrier phase of the satellite, ab is the differential calculation for GNSS receiver a and GNSS receiver b, mn is the difference between the two satellites m and n that meet the quadratic differential threshold, λ is the carrier phase wavelength, ε is the carrier phase measurement noise, X is the integer ambiguity to be solved, and r is the final solved spatial rectangular coordinate system vector line, i.e., the baseline.

[0193] 2. Floating point solution calculation

[0194] According to the carrier phase difference formula, the least squares method is used to construct the formula to solve r and X, where:

[0195]

[0196] Where I is the identity matrix. Since G T G is a singular matrix, and the adaptive spectrum correction is used to solve it:

[0197] Δx( k )=(G T G+aI)- 1 (G T B+aΔx( k - 1 ))

[0198] Among them, k represents the number of iterations, and the size of a is dynamically adjusted in each iteration. Increasing a helps to improve the ill-conditioning of the matrix, and reducing a helps to increase the iteration speed.

[0199] 3. Floating point solution fixed

[0200] Obtain floating point decimals Δx and (G T G+aI) -1 Covariance matrix, using the least squares ambiguity reduction correlation adjustment method to extract the integer ambiguity part of the floating point decimal, the floating point solution X and the floating point solution covariance matrix Q that removes the baseline part but retains the integer ambiguity part X , the floating point solution covariance matrix is ​​decomposed by the square root method Choleshy, where:

[0201] Q X =L T DL

[0202] Among them, L represents the lower triangular matrix, T represents the transpose, and D represents the diagonal matrix;

[0203] Perform a Z transform on the floating-point solution:

[0204]

[0205] Compute the integer ambiguity:

[0206]

[0207] This formula means that by changing the integer ambiguity X 0 To find the integer ambiguity that makes the left side of the equation reach the minimum value, where min is the minimum value finally reached;

[0208] Determine the search space K:

[0209]

[0210] Search K for integer ambiguities that satisfy the predetermined conditions:

[0211]

[0212] The optimal solution of the integer ambiguity is obtained by the inverse Z transform:

[0213]

[0214] 4. Baseline solution

[0215] The optimal solution X of the integer ambiguity is obtained from the search results in the search space K. 0 and the suboptimal solution X 1 , where the optimal solution X 0 The corresponding residual is The residual corresponding to the suboptimal solution X1 is Residual Ratio Using the formula Find the optimal solution baseline r 0 and the suboptimal solution baseline r 1 , where X is the baseline floating point solution;

[0216] When RT is greater than or equal to the predetermined residual threshold, the optimal solution baseline r is output. 0 is the baseline r output by this module, and determines the optimal solution baseline r 0 Satisfy the predetermined accuracy conditions;

[0217] When RT is less than the predetermined residual threshold, further determine ||r 1 |-|r 0 Is the value of || less than the predetermined baseline difference threshold? If so, the optimal solution baseline r is determined 0 is the reference solution r that does not meet the predetermined accuracy conditions ref , and output the reference solution r ref , the reference solution is used in step three data fusion, and the weight ratio is greatly reduced; the specific weight ratio can be set in advance.

[0218] Step 2: Loosen the combination

[0219] 1. Define the second state vector x1, where:

[0220]

[0221] P gnss represents a GNSS position vector including latitude, longitude and altitude determined according to the first GNSS signal and the second GNSS signal, v gnss represents the GNSS speed determined according to the first GNSS signal and the second GNSS signal, q imu Indicates the attitude quaternion of the IMU module, b imu Represents the zero bias estimation of the IMU module;

[0222] 2. Establishment of system state equation and observation equation

[0223] Establish the system state equation, which describes the time evolution of the state vector:

[0224] x1(k+1)=F(k)*x1(k)+G(k)*w(k)

[0225] F(k) is the state transfer matrix, which represents the change of the second state vector between time k and k+1; G(k) is the system noise matrix, which represents the influence of system noise on the second state vector; w(k) is the system noise vector;

[0226] Establish the observation equation, which associates the state vector and the observation data, where:

[0227] z(k)=H(k)*x1(k)+v(k)

[0228] z(k) is the observation vector, including the observation data of the GNSS receiver and the measurement data of the IMU module; H(k) is the observation matrix, which represents the relationship between the observation data and the second state vector; v(k) is the observation noise vector.

[0229] 3. State prediction

[0230] The estimated value of the second state vector at the current moment is predicted according to the system state equation, where:

[0231] x pre (k+1)=F(k)*x est (k)

[0232] Among them, x pre (k+1) is the predicted value of the second state vector, x est (k) is the estimated value of the second state vector at the current moment.

[0233] 4. Covariance prediction

[0234] The covariance forecast is the covariance matrix of the estimated state forecast errors, where:

[0235] P pre (k+1)=F(k)*P est (k)*F(k) T +G(k)*Q(k)*G(k) T

[0236] Among them, P pre (k+1) is the predicted covariance matrix, P est (k) is the estimated value of the covariance matrix at the current moment, and Q(k) is the covariance matrix of the system noise.

[0237] 5. Calculation of Kalman gain

[0238] The Kalman gain is calculated based on the predicted covariance matrix and the observed noise covariance matrix:

[0239] K(k+1)=P ore (k+1)*H(k+1) T *(H(k+1)*P pre (k+1)*H(k+1) T +R(k+1) -1 )

[0240] Where K(k+1) represents the calculated Kalman gain, H(k+1) represents the observation matrix at the next moment after the kth moment, and R(k+1) represents the observation noise covariance matrix;

[0241] 6. Status Update

[0242] The predicted value of the second state vector is corrected according to the Kalman gain and the observation residual, where:

[0243] x est (k+1)=x pre (k+1)+K(k+1)*(z(k+1)-H(k+1)*x pre (k+1))

[0244] Among them, x est (k+1) represents the modified second state vector; z(k+1) is the observation vector at the next moment after the kth moment.

[0245] 7. Covariance Update

[0246] The predicted covariance matrix is ​​modified according to the Kalman gain, where:

[0247] P est (k+1)=(IK(k+1)*H(k+1)*Ppre (k+1))

[0248] Among them, P est (k+1) represents the modified covariance matrix, and I represents the identity matrix.

[0249] 8. Correction of zero bias error

[0250] Extract the zero bias estimate b of the IMU module from the corrected second state vector imu , use the extracted zero bias estimate to correct the measurement value of the IMU module, and convert the corrected measurement value of the IMU module from quaternion to Euler angle. The heading angle contained in the Euler angle is used for data fusion in step three.

[0251] Step 3: Kalman-based data fusion

[0252] This step describes how to use the Kalman filter to fuse the high-precision single-epoch solution heading angle and IMU heading angle data. The model effectively fuses the high-precision single-epoch solution heading angle and IMU heading angle data by dynamically adjusting the observation noise covariance and flexibly handling the update frequency of different data sources. This method improves the accuracy and stability of heading angle estimation while ensuring real-time performance.

[0253] 1. Define the first state vector x0, where:

[0254]

[0255] Where θ represents the heading angle, represents the rate of change of the heading angle θ;

[0256] 2. Observation Model

[0257] Since the heading angle of the IMU has a fixed deviation, we cannot directly use its absolute value, but should use the rate of change of the heading angle. Therefore, the observation vector z and the observation model need to be adjusted accordingly;

[0258] When the heading angle calculated using a single epoch baseline solution (true value) is used, the observation vector is:

[0259] z gnss =[θ gnss ]

[0260] Among them, θ gnss is to solve the heading angle;

[0261] When using IMU data (rate of change), the observation vector is:

[0262] Z IMU =[△θ IMU ]

[0263] Among them, Δθ IMU is the rate of change of heading angle measured by the IMU.

[0264] The observation models are:

[0265] Z gnss =H gnss x+v gnss

[0266] Z IMU =H IMU x+v IMU

[0267] Among them, z gnss To calculate the observation vector of the heading angle, v gnss To resolve the observation noise of the heading angle, z IMU H is the observation vector of the heading angle data measured by the IMU module. gnss To calculate the observation moment of heading angle

[0268] Array, H IMU The observation matrix of the heading angle data measured by the IMU module, v IMU is the observation noise of the heading angle data measured by the IMU module, v gnss With v IMU The value of is predetermined.

[0269] 3. Observation Matrix

[0270] The observation matrix for calculating the heading angle is:

[0271] H gnss =[1 0]

[0272] The observation matrix of the heading angle data measured by the IMU module is:

[0273] H IMU =[0 1].

[0274] 4. Noise covariance matrix R

[0275] The observation noise covariance R is a key parameter that reflects the uncertainty of the observation data. In this embodiment, the value of R is dynamically adjusted according to the quality of the observation data. The value of the observation noise covariance R is determined, where:

[0276] For the case where the observation data is used to calculate the heading angle, if the accuracy of the baseline solution meets the predetermined accuracy condition, the value of the observation noise covariance is When the output optimal solution baseline r 0 This is the case when ; otherwise, the value of the observation noise covariance is When the calculated baseline is the reference solution r refThis is the case when

[0277] For the case where the observation data is the heading angle data measured by the IMU module, the value of the observation noise covariance is

[0278] in, and The values ​​of are predetermined.

[0279] 5. Prediction Model

[0280] The state prediction is performed using the state transfer matrix F and process noise w, where:

[0281] x pred =Fx prev +w

[0282] Among them, x prev is the first state vector at the previous moment, w is a fixed coefficient, and F is:

[0283]

[0284] Δt IMU It is the data update interval of the IMU module.

[0285] 6. Update steps

[0286] Calculate the Kalman gain K and use K to update the first state vector and the error covariance P, where:

[0287] K=PH T (HPH T +R) -1

[0288] Update the first state vector by the following formula:

[0289] x0=x pred +K(z-Hx pred )

[0290] Update the error covariance P by the following formula:

[0291] P=(I-KH)P

[0292] Among them, x pred is the predicted value of the first state vector, H is the corresponding observation matrix, z is the corresponding observation vector, the initial value of P is the unit matrix, and I is the unit matrix.

[0293] 7. Observation data processing and strategies for inconsistent update frequencies of IMU data and GNSS data, specifically explaining step 6 above:

[0294] a. IMU data update. For example, IMU data is updated every 0.1 seconds:

[0295] When IMU data arrives, use it to update the state prediction x pred .

[0296] If any GNSS receiver does not have new epoch data, use the IMU data to make a slight state adjustment:

[0297] x0=x pred +K IMU (z IMU -Hx pred )

[0298] Among them, K IMU is the Kalman gain based on IMU data, Z IMU is the observation vector of the IMU module.

[0299] b. GNSS data, i.e. single ephemeris data, is updated, for example, every several seconds:

[0300] When any GNSS receiver receives single epoch data, a notable status update is performed:

[0301] x0=x pred +K GNSS (Z GNSS -Hx pred )

[0302] Among them, K GNSS is the Kalman gain based on single epoch data, Z GNSS is the observation vector for a single epoch.

[0303] Step 4: Extract the output heading angle

[0304] The updated first state vector in step 3 is:

[0305]

[0306] Among them, θ is the final output fusion heading angle.

[0307] Embodiment three:

[0308] The present invention also provides a device for baseline solution and IMU data fusion, such as Figure 2As shown, the device includes a processor 201, a memory 202, a bus 203, and a computer program stored in the memory 202 and executable on the processor 201. The processor 201 includes one or more processing cores. The memory 202 is connected to the processor 201 via the bus 203. The memory 202 is used to store program instructions. When the processor executes the computer program, the steps in the above method embodiment of the first embodiment of the present invention are implemented.

[0309] Further, as an executable solution, the device for baseline solution and IMU data fusion can be a computer unit, which can be a computing device such as a desktop computer, a notebook, a PDA, and a cloud server. The computer unit may include, but is not limited to, a processor and a memory. Those skilled in the art will understand that the composition structure of the above-mentioned computer unit is only an example of a computer unit and does not constitute a limitation on the computer unit. It may include more or less components than the above, or a combination of certain components, or different components. For example, the computer unit may also include input and output devices, network access devices, buses, etc., which are not limited in the embodiments of the present invention.

[0310] Further, as an executable solution, the processor may be a central processing unit (CPU), other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or any conventional processor, etc. The processor is the control center of the computer unit, and various interfaces and lines are used to connect the various parts of the entire computer unit.

[0311] The memory can be used to store the computer program and / or module, and the processor realizes various functions of the computer unit by running or executing the computer program and / or module stored in the memory, and calling the data stored in the memory. The memory can mainly include a program storage area and a data storage area, wherein the program storage area can store an operating system and at least one application required for a function; the data storage area can store data created according to the use of the mobile phone, etc. In addition, the memory can include a high-speed random access memory, and can also include a non-volatile memory, such as a hard disk, a memory, a plug-in hard disk, a smart memory card (Smart Media Card, SMC), a secure digital (SecureDigital, SD) card, a flash card (Flash Card), at least one disk storage device, a flash memory device, or other volatile solid-state storage devices.

[0312] Embodiment 4:

[0313] The present invention also provides a computer-readable storage medium, wherein the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the above method in the embodiment of the present invention are implemented.

[0314] If the module / unit integrated in the computer unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the present invention implements all or part of the processes in the above-mentioned embodiment method, and can also be completed by instructing the relevant hardware through a computer program. The computer program can be stored in a computer-readable storage medium, and the computer program can implement the steps of the above-mentioned various method embodiments when executed by the processor. Among them, the computer program includes computer program code, and the computer program code can be in source code form, object code form, executable file or some intermediate form. The computer-readable medium may include: any entity or device capable of carrying the computer program code, recording medium, U disk, mobile hard disk, disk, optical disk, computer memory, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory) and software distribution medium, etc. It should be noted that the content contained in the computer-readable medium can be appropriately increased or decreased according to the requirements of legislation and patent practice in the jurisdiction.

[0315] Embodiment five:

[0316] The present invention also provides a computer program product, comprising a computer program, wherein when the computer program is executed by a processor, the steps of the method described above are implemented.

[0317] Although the present invention has been specifically shown and described in conjunction with the preferred embodiments, it should be understood by those skilled in the art that various changes may be made to the present invention in form and details without departing from the spirit and scope of the present invention as defined by the appended claims, all of which are within the scope of protection of the present invention.

Claims

1. A method of baseline solution and IMU data fusion, It is characterized in that include: Step S1, obtaining at least a first GNSS signal and a second GNSS signal through at least two GNSS receivers arranged on the mobile device, and obtaining local IMU data through an IMU module arranged on the mobile device; Step S2, performing a single epoch baseline solution on the first GNSS signal and the second GNSS signal to obtain a baseline solution and a solved heading angle; Step S3, using the IMU module to perform integration processing on the local IMU data to obtain the heading angle data measured by the IMU module, the heading angle data measured by the IMU module including: heading angle change rate; Step S4, performing data fusion on the calculated heading angle and the heading angle data measured by the IMU module based on the established Kalman filter; Wherein, establishing the Kalman filter comprises: Step S41, define the first state vector x 0 ,in: Where θ represents the heading angle, represents the rate of change of the heading angle θ; Step S42, establishing observation models for the calculated heading angle and the heading angle data measured by the IMU module, respectively, wherein: z gnss =H gnss x 0 +v gnss z IMU =H IMU x 0 +v IMU Among them, z gnss is the observation vector for calculating the heading angle, v gnss is the observation noise for calculating the heading angle, H gnss is the measurement matrix for calculating the heading angle, H gnss =[1 0],z IMU is the observation vector of the heading angle data measured by the IMU module, H IMU is the observation matrix of the heading angle data measured by the IMU module, H IMU =[0 1],v IMU is the observation noise of the heading angle data measured by the IMU module, v gnss With v IMU The value of is predetermined; Step S43, determining the value of the observation noise covariance R, where: For the case where the observed data is the calculated heading angle, if the accuracy of the baseline solution meets the predetermined accuracy condition, the value of the observed noise covariance is Otherwise, the value of the observation noise covariance is For the case where the observation data is the heading angle data measured by the IMU module, the value of the observation noise covariance is in, and The values ​​of are predetermined; Step S44, using the state transfer matrix F and process noise w to perform state prediction, where: x pred =Fx prev +w Among them, x prev is the first state vector at the previous moment, w is a fixed coefficient, and F is: Δt IMU is the data update interval of the IMU module; Step S45, calculating the Kalman gain K, and using the K to update the first state vector and the error covariance P, where: K=PH T (HPH T +R) -1 The first state vector is updated by the following formula: x 0 =x pred +K(z-H xpred ) Update the error covariance P by the following formula: P=(I-KH)P Among them, x pred is the predicted value of the first state vector, H is the corresponding observation matrix, z is the corresponding observation vector, the initial value of P is the unit matrix, and I is the unit matrix; When the data is updated, if the data arriving is the data of the IMU module, then K is the Kalman gain K based on the IMU module data. IMU , z is the observation vector Z of the IMU module IMU If the data received is the data obtained by the single epoch baseline solution, then K is the Kalman gain K based on the single epoch baseline solution data. GNSS , z is the observation vector z for calculating the heading angle gnss ; Step S5, from the updated first state vector x 0 The fused heading angle is extracted from the 2. According to the method of baseline solution and IMU data fusion according to claim 1, It is characterized in that The step S2 comprises: Perform single epoch baseline solution on the first GNSS signal and the second GNSS signal to obtain the optimal solution X of the integer ambiguity to be solved 0 and the suboptimal solution X 1 , where the optimal solution X 0 The corresponding residual is The suboptimal solution X 1 The corresponding residual is Residual Ratio According to the resolved integer ambiguity, the optimal solution baseline r is determined 0 and the suboptimal solution baseline r 1 ; When the RT is greater than or equal to the predetermined residual threshold, the optimal solution baseline r is output. 0 , and determine the optimal solution baseline r 0 Satisfying the predetermined accuracy condition, when using the optimal solution baseline r 0 When data fusion is performed, the value of the observation noise covariance is When the RT is less than the residual threshold, further determine ||r 1 |-|r 0 Is the value of || less than the predetermined baseline difference threshold? If so, the optimal solution baseline r is determined 0 is a reference solution that does not meet the predetermined accuracy conditions. ref , and output the reference solution r ref , using the reference solution r ref When data fusion is performed, the value of the observation noise covariance is 3. The method of baseline solution and IMU data fusion according to claim 1, It is characterized in that The step S2 further comprises: The carrier phase smoothness screening method is used to select satellites for GNSS receivers to calculate positions; The following calculations are performed for each satellite: in, is the satellite carrier phase received at the i-th moment, is the satellite carrier phase received at the moment before the i-th moment, is the first differential value of the satellite carrier phase at the i-th moment, is the first differential value of the satellite carrier phase at the moment before the i-th moment, is the secondary difference value of the satellite carrier phase at the i-th moment; Choose to meet satellites to calculate the position, where Indicates the preset secondary difference threshold.

4. According to the method of baseline solution and IMU data fusion as claimed in claim 1, It is characterized in that The step of loosely combining the first GNSS signal, the second GNSS signal and the local IMU data is also included; Wherein, the loose combination includes: Define the second state vector x 1 ,in: Among them, P gnss represents a GNSS position vector including latitude, longitude and altitude determined according to the first GNSS signal and the second GNSS signal, v gnss represents the GNSS speed determined according to the first GNSS signal and the second GNSS signal, q imu Represents the attitude quaternion of the IMU module, b imu Represents the zero bias estimation of the IMU module; Establish the system state equation: x 1 (k+1)=F(k)*x 1 (k)+G(k)*w(k) Wherein, F(k) is a state transfer matrix, which represents the change of the second state vector between time k and k+1; G(k) is a system noise matrix, which represents the influence of system noise on the second state vector; w(k) is a system noise vector; Establish the observation equation: z(k)=H(k)*x 1 (k)+v(k) Wherein, z(k) is an observation vector, including the observation data of the GNSS receiver and the measurement data of the IMU module; H(k) is an observation matrix; v(k) is an observation noise vector; predicting an estimated value of the second state vector at the current moment according to the system state equation, x pre (k+1)=F(k)*x est (k) Among them, x pre (k+1) is the predicted value of the second state vector, x est (k) is the estimated value of the second state vector at the current moment; Make a covariance matrix prediction, where: P pre (k+1)=F(k)*P est (k)*F(k) T +G(k)*Q(k)*G(k) T Among them, P pre (k+1) is the predicted covariance matrix, P est (k) is the estimated value of the covariance matrix at the current moment, and Q(k) is the covariance matrix of the system noise; The Kalman gain is calculated based on the predicted covariance matrix and the observed noise covariance matrix: K(k+1)=P pre (k+1)*H(k+1) T *(H(k+1)*P pre (k+1)*H(k+1) T +R(k+1) -1 ) Where K(k+1) represents the calculated Kalman gain, H(k+1) represents the observation matrix at the next moment after the kth moment, and R(k+1) represents the observation noise covariance matrix; The predicted value of the second state vector is corrected according to the Kalman gain and the observation residual, wherein: x est (k+1)=x pre (k+1)+K(k+1)*(z(k+1)-H(k+1)*x pre (k+1)) Among them, x est (k+1) represents the second state vector after correction; z(k+1) is the observation vector at the next moment of the kth moment; The predicted covariance matrix is ​​modified according to the Kalman gain, where: P est (k+1)=(I-K(k+1)*H(k+1)*P pre (k+1)) Among them, P est (k+1) represents the modified covariance matrix, and I represents the identity matrix; Extract the zero bias estimate b of the IMU module from the corrected second state vector imu , use the extracted zero bias estimate to correct the measurement value of the IMU module, and convert the corrected measurement value of the IMU module from quaternion to Euler angle, and the heading angle contained in the Euler angle is used for data fusion in step S4.

5. The method of baseline solution and IMU data fusion according to claim 1, It is characterized in that In step S42, when the heading angle calculated by the single epoch baseline solution is used, the observation vector is: With gnss =[θ gnss ] Among them, θ gnss is the solved heading angle; When using the local IMU data, the observation vector is: z IMU =[Δθ IMU ] Among them, Δθ IMU is the rate of change of heading angle obtained according to the local IMU data.

6. The method of baseline solution and IMU data fusion according to claim 1, It is characterized in that The step S45 further includes: When the at least two GNSS receivers do not receive the GNSS signal, but the IMU module obtains local IMU data, the first state variable is updated using the obtained local IMU data: x 0 =x pred +K IMU (z IMU -Hx pred ) When the at least two GNSS receivers receive a GNSS signal, the first state variable is updated by the GNSS signal: x 0 =x pred +K GNSS (z GNSS -Hx pred )。 7. A device for baseline solution and IMU data fusion, It is characterized in that It includes a memory and a processor, the memory stores at least one program, and the at least one program is executed by the processor to implement the method of baseline solution and IMU data fusion as described in any one of claims 1 to 6.

8. A computer-readable storage medium, It is characterized in that The storage medium stores at least one program, and the at least one program is executed by a processor to implement the method of baseline solution and IMU data fusion as described in any one of claims 1 to 6.

9. A computer program product comprising a computer program, It is characterized in that When the computer program is executed by a processor, the method for baseline solution and IMU data fusion as described in any one of claims 1 to 6 is implemented.

Citation Information

Cited By

  • Physical parameter estimation method and device based on sensor

    CN119845261A

  • A physical parameter estimation method and device based on sensor

    CN119845261B

  • Method and device for calibrating course angle deviation of phase center and geometric center of short baseline

    CN119846681A

  • TDOA (Time Difference Of Arrival) refining method, device and equipment for AIS (Automatic Identification System) signal and storage medium

    CN120722274A