CN114859389A - GNSS multi-system robust adaptive fusion RTK resolving method - Google Patents
GNSS multi-system robust adaptive fusion RTK resolving method Download PDFInfo
- Publication number
- CN114859389A CN114859389A CN202210405810.XA CN202210405810A CN114859389A CN 114859389 A CN114859389 A CN 114859389A CN 202210405810 A CN202210405810 A CN 202210405810A CN 114859389 A CN114859389 A CN 114859389A
- Authority
- CN
- China
- Prior art keywords
- rtk
- observation
- formula
- equation
- bds
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 48
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 45
- 230000004927 fusion Effects 0.000 title claims abstract description 31
- 238000001914 filtration Methods 0.000 claims abstract description 28
- 241001061260 Emmelichthys struhsakeri Species 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 40
- 230000008569 process Effects 0.000 claims description 25
- 150000001875 compounds Chemical class 0.000 claims description 21
- 238000012937 correction Methods 0.000 claims description 8
- 230000000694 effects Effects 0.000 claims description 3
- 230000008570 general process Effects 0.000 claims description 3
- 239000005433 ionosphere Substances 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 230000008054 signal transmission Effects 0.000 claims description 3
- 239000000126 substance Substances 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 239000005436 troposphere Substances 0.000 claims description 3
- 230000005856 abnormality Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 239000013585 weight reducing agent Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/33—Multimode operation in different systems which transmit time stamped messages, e.g. GPS/GLONASS
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/35—Constructional details or hardware or software details of the signal processing chain
- G01S19/37—Hardware or software details of the signal processing chain
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/40—Correcting position, velocity or attitude
- G01S19/41—Differential correction, e.g. DGPS [differential GPS]
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Signal Processing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
The invention discloses a GNSS multi-system robust adaptive fusion RTK resolving method, which comprises the following steps: step 1: establishing a conventional RTK double-difference observation equation according to BDS/GPS/GLONASS/GLILEO multi-system observation data of the base station and the rover station; step 2: conventional Kalman filtering solution; and step 3: robust Kalman adaptive filtering estimation; and 4, step 4: the estimation of Helmert variance component is fused in the BDS/GPS/GLONASS/GLILEO multi-system; and 5: BDS/GPS/GLONASS/GLILEO multisystem RTK ambiguity fix. The method can effectively reduce the influence of the inaccuracy of the GNSS positioning prior random model and the observation containing abnormity and the abnormity of the dynamic model on the positioning of the multi-system fusion RTK, and improve the positioning precision of the GNSS (BDS/GPS/GLONASS/GLILEO) multi-system fusion RTK, so that the RTK positioning result is more stable and reliable in a complex environment.
Description
Technical Field
The invention belongs to the field of GNSS satellite navigation positioning, and particularly relates to a GNSS multi-system robust self-adaptive fusion RTK resolving method.
Background
With the continuous development of global satellite navigation systems and the combination of different satellite constellations, the number of visible satellites provided is gradually increased, and the space geometric distribution of the satellites is more perfect. The GNSS (BDS/GPS/GLONASS/GLILEO) multi-system fusion provides more reliable guarantee for high-precision positioning due to the introduction of more visible satellites. However, due to the difference of the constellation and satellite orbit distribution of each satellite navigation system, the navigation positioning performance and the accuracy of the observed value of each system are different, and the GNSS multi-system fusion positioning only determines that the weight ratio of the observed value of each system is inaccurate and reliable according to the prior accuracy. Meanwhile, in the regions such as cities, canyons and the like, due to the fact that the observation environment is complex, multipath or non-line-of-sight signals are formed by satellite signals due to reflection or scattering of buildings, the probability that an observation value contains gross errors or is abnormal is increased, and a carrier motion model is difficult to model accurately under a dynamic condition, so that large deviation and even divergence are prone to occur in conventional Kalman filtering positioning calculation.
Therefore, for GNSS multi-system fusion positioning, especially for application in complex environments, how to determine the weight of each observation value among navigation systems and each satellite without relying on prior theory or empirical value is important for improving the precision and the availability of GNSS multi-system fusion RTK positioning by self-adaptively adjusting the weight of each observation value among navigation systems and satellites.
Disclosure of Invention
The invention aims to provide a GNSS multi-system robust adaptive fusion RTK resolving method which is used for effectively reducing the influence of inaccuracy of a GNSS positioning prior random model, observation containing abnormality and dynamics model abnormality on positioning of a multi-system fusion RTK and improving the positioning precision of the GNSS (BDS/GPS/GLONASS/GLILEO) multi-system fusion RTK so that an RTK positioning result is more stable and reliable in a complex environment.
In order to achieve the purpose, the technical scheme of the invention is as follows:
a GNSS multi-system robust adaptive fusion RTK resolving method comprises the following steps:
step 1: establishing a conventional RTK double-difference observation equation according to BDS/GPS/GLONASS/GLILEO multi-system observation data of the base station and the rover station;
step 2: conventional Kalman filtering solution;
and step 3: robust Kalman adaptive filtering estimation;
and 4, step 4: the estimation of Helmert variance component is fused in the BDS/GPS/GLONASS/GLILEO multi-system;
and 5: BDS/GPS/GLONASS/GLILEO multisystem RTK ambiguity fix.
Further, as a preferred technical scheme, the specific process of the step 1 is as follows:
step 1-1: establishing a basic observation equation based on the non-difference original pseudo range and the carrier phase observation value, which comprises the following specific steps:
in the formula, subscripts i and r are frequency and station survey of observed quantity respectively, and superscript j is a satellite;respectively, a pseudo range and a carrier phase original observed value, taking meters as a unit,as phase observations (weeks);geometric distance from satellite to station at the moment of signal transmission, c speed of light in vacuum, dt r And dt j Respectively receiver clock error and satellite clock error, T j In order to delay the tropospheric delay,is the ionospheric delay at the frequency i,andreceiver-side and satellite-side pseudorange hardware delay biases,andphase hardware delay biases including carrier phase hardware delay bias and initial phase bias, λ, at the receiver end and at the satellite end, respectively i Andcarrier phase wavelength at frequency i and integer ambiguity,andthe measurement noise is respectively the pseudo range and the carrier phase observation value;
step 1-2: according to the RTK double-difference model, the satellite clock difference and the receiver clock difference in the step 1-1 can be eliminated, the influences of satellite orbit errors, troposphere delay errors, ionosphere delay errors, multipath effects and the like are weakened, and a carrier phase double-difference observation equation is established, which specifically comprises the following steps:
in the formula, superscripts j and k represent satellite numbers; the r, b subscripts denote rover and reference stations;a double-difference phase observed value of an epoch t;the distance from the satellite s to the survey station r;is double-difference ambiguity; since the reference coordinates are known, the above equation can be converted into:
step 1-3: the prior coordinate of the rover station adopts single-point positioning estimation to approximate an estimated value X r =(x r ,y r ,z r ) T Let its correction number be δ X r =(δx r ,δy r ,δz r ) T And linearizing the equation finally converted in the step 1-2 to obtain a carrier phase double-difference error equation:
similarly, a pseudorange double difference error equation may be obtained:
Further, as a preferred technical scheme, the specific process of the step 2 is as follows:
step 2-1: establishing a Kalman filtering state equation and an observation equation:
X k =Φ k,k-1 X k-1 +W k-1
L k =A k X k +V k
wherein k represents an observation epoch time, X k Representing the state vector at time k, phi k,k-1 A transition matrix, W, representing the state of the system from time k-1 to time k k-1 Is a dynamic noise vector, L k For the observation vector at time k, A k For observing the coefficient matrix of the equation, V k To observe the noise vector;
step 2-2: the observed values are regarded as mutually independent, and the dynamic noise and the observed noise are white noise with zero mean and mutually irrelevant, namely the following conditions are met:
in the formula, omega k Is an array of variances of process noise, Q k A variance matrix for the observed noise;
step 2-3: the state equation and the observation equation are respectively rewritten as an error equation:
in the formula (I), the compound is shown in the specification,and V k Respectively predicting values for state parametersAnd the observed value L k Residual vector of (2), and state parameter prediction valueComprises the following steps:
constructing an objective function according to a least square criterion:
in the formula, P k Andrespectively are observed values L k And status parameter prediction valueIs expressed as
further, the following can be obtained:
step 2-4: substituting an error equation corresponding to the observation equation into the formula (1) to obtain:
further, as a preferred technical solution, a general process of further deriving Kalman filter calculation by matrix identity transformation and matrix inversion formula is as follows:
step 2-4-1: calculating a Kalman filtering gain matrix K according to the prediction precision of the current epoch by the previous epoch k ,
Step 2-4-2: updating the current epoch observed value, namely performing weighted correction by using the weight of the current epoch measured value,
step 2-4-3: and updating the time, namely predicting the observation value of the next epoch.
Further, as a preferred technical solution, the specific process of step 3 is:
step 3-1: the robust adaptive Kalman filter solution is:
in the formula (I), the compound is shown in the specification,is L k Is an adaptive estimate of the observation vector weight matrix, alpha k Alpha is 0-alpha for the adaptive factor k ≤1;
Step 3-2: equivalent weight factors and adaptive weight factors are determined.
Further, as a preferred technical solution, the specific calculation process of the equivalent weight factor is as follows:
step 3-2-1: in BDS/GPS/GLONASS/GALILEO fusion positioning, the observed values among systems are independent, and the corresponding equivalence weights are as follows:
in the formula, P i Is the original weight matrix, w i Is an adaptive weight factor;
step 3-2-2: determining the weight factor by adopting an IGGIII equivalent weight factor-based function or a two-factor equivalent weight factor-based function, wherein the function expression based on the IGGIII equivalent weight factor is as follows:
in the formula (I), the compound is shown in the specification,to normalize the residual, k 1 、k 2 Is a constant, typically take k 1 =1.5~2.0,k 2 =3.0~8.0;
The function expression based on the two-factor equivalent weight factor is as follows:
wherein c is a constant, c is 2.5-3.0, and i and j represent row and column numbers of the matrix;
Step 3-2-4: normalized residual error for different types of observationsComprises the following steps:
further, as a preferred technical solution, the specific calculation process of the adaptive weight factor is as follows:
calculating adaptive weight factor a by using two-segment function k Namely:
wherein c is a constant, c is 1.0 to 2.5,
in the formula (I), the compound is shown in the specification,in order to normalize the prediction residual error,the residual is predicted for the state parameters,the trace of the residual covariance matrix is predicted for the state parameters.
Further, as a preferred technical solution, the specific process of step 4 is as follows:
step 4-1: during the first filtering, the BDS, GPS, GLONASS and GLILEO observed values are firstly verified according to the altitude angle of the satellite to obtain the weight P C :P G :P R :P E ;
Step 4-2: performing filtering calculation to obtain V i T P i V i (i=C,G,R,E);
Step 4-3: and (3) carrying out variance component estimation:
in the formula (I), the compound is shown in the specification,
N=A T PA=A C T P C A C +A G T P G A G +A R T P R A R +A E T P E A E =N C +N G +N R +N E
wherein n is C 、n G 、n R And n E The numbers of BDS, GPS, GLONASS and GALILEO observed values respectively;
step 4-4: re-weighting:
Further, as a preferred technical solution, when iteration fails to converge or convergence distortion occurs in step 4, the satellites are rescreened or the weights of some satellites are appropriately reduced, and then solution is performed.
Further, as a preferred technical solution, in the step 5, the BDS/GPS/GLONASS/glieo multi-system RTK ambiguity fix is performed by using a least square ambiguity downcorrelation adjustment method in combination with a partial ambiguity fix strategy.
Compared with the prior art, the invention has the following beneficial effects:
aiming at GNSS multi-system fusion RTK, firstly, the weight of each satellite observation value is adjusted by adopting robust Kalman adaptive filtering to inhibit the influence of observation abnormity and dynamic model errors on RTK estimation parameters, secondly, the weight of the observation value among each satellite navigation system (BDS/GPS/GLONASS/GLILEO) is adaptively adjusted by adopting variance component estimation, and the weight ratio among observation values with different types or unequal precision is adaptively adjusted by iterative calculation to ensure that the weight distribution is more reasonable, so that the GNSS multi-system fusion RTK positioning is more accurate and reliable in a complex environment.
Drawings
FIG. 1 is a schematic view of the process structure of the present invention.
Detailed Description
The following examples are intended to illustrate the invention but are not intended to limit the scope of the invention.
Examples
As shown in fig. 1, the method for solving the GNSS multi-system robust adaptive fusion RTK according to this embodiment includes the following steps:
step 1: establishing a conventional RTK double-difference observation equation according to BDS/GPS/GLONASS/GLILEO multi-system observation data of the base station and the rover station;
step 2: conventional Kalman filtering solution;
and step 3: robust Kalman adaptive filtering estimation;
and 4, step 4: the estimation of Helmert variance component is fused in the BDS/GPS/GLONASS/GLILEO multi-system;
and 5: BDS/GPS/GLONASS/GLILEO multisystem RTK ambiguity fix.
In this embodiment, the specific process of step 1 is as follows:
step 1-1: establishing a basic observation equation based on the non-difference original pseudo range and the carrier phase observation value, which comprises the following specific steps:
in the formula, subscripts i and r are frequency and station survey of observed quantity respectively, and superscript j is a satellite;respectively, a pseudo range and a carrier phase original observed value, taking meters as a unit,as phase observations (weeks);geometric distance from satellite to station at the moment of signal transmission, c speed of light in vacuum, dt r And dt j Respectively receiver clock error and satellite clock error, T j In order to delay the tropospheric delay,is the ionospheric delay at the frequency i,andreceiver-side and satellite-side pseudorange hardware delay biases,andphase hardware delay biases including carrier phase hardware delay bias and initial phase bias, λ, at the receiver end and at the satellite end, respectively i Andcarrier phase wavelength at frequency i and integer ambiguity,andthe measurement noise is respectively the pseudo range and the carrier phase observation value;
step 1-2: according to the RTK double-difference model, the satellite clock difference and the receiver clock difference in the step 1-1 can be eliminated, the influences of satellite orbit errors, troposphere delay errors, ionosphere delay errors, multipath effects and the like are weakened, and a carrier phase double-difference observation equation is established, which specifically comprises the following steps:
in the formula, superscripts j and k represent satellite numbers; the r, b subscripts denote rover and reference stations;a double-difference phase observed value of an epoch t;the distance from the satellite s to the survey station r;is double-difference ambiguity; since the reference coordinates are known, the above equation can be converted into:
step 1-3: the prior coordinate of the rover station adopts single-point positioning estimation to approximate an estimated value X r =(x r ,y r ,z r ) T Let its correction number be δ X r =(δx r ,δy r ,δz r ) T And linearizing the equation finally converted in the step 1-2 to obtain a carrier phase double-difference error equation:
similarly, a pseudorange double difference error equation may be obtained:
In this embodiment, the specific process of conventional Kalman filter solution is as follows:
the Kalman filtering is based on a set of observation sequences L k (k 1, 2.., n) and the kinetic model information of the system to solve the state vector estimate. In the precision positioning, a state vector consists of parameters to be estimated, a dynamic model is established according to the correlation of the before and after epochs of the parameters to be estimated, and a filtering state equation and an observation equation are as follows:
X k =Φ k,k-1 X k-1 +W k-1
L k =A k X k +V k
wherein k represents an observation epoch time, X k Representing the state vector at time k, phi k,k-1 A transition matrix, W, representing the state of the system from time k-1 to time k k-1 Is a dynamic noise vector, L k For the observation vector at time k, A k For observing the coefficient matrix of the equation, V k To observe the noise vector;
generally, the observed values are regarded as mutually independent, and the dynamic noise and the observed noise are white noises which are zero-mean and mutually uncorrelated, that is, the following conditions are satisfied:
in the formula, omega k Is an array of variances of process noise, Q k A variance matrix for the observed noise;
in order to solve the least square solution of the state parameters, Kalman filtering is used for solving according to the free extreme value principle, and a state equation and an observation equation are respectively rewritten into error equations:
in the formula (I), the compound is shown in the specification,and V k Respectively predicting values for state parametersAnd the observed value L k Residual vector of (2), and state parameter prediction valueComprises the following steps:
constructing an objective function according to a least square criterion:
in the formula, P k Andrespectively is an observed value L k And status parameter prediction valueIs expressed as
further, the method can be obtained as follows:
step 2-4: substituting the error equation into the above formula to obtain:
the general process of further deducing Kalman filtering calculation by a matrix identity transformation and matrix inversion formula is as follows:
step 2-4-1: calculating a Kalman filtering gain matrix K according to the prediction precision of the current epoch by the previous epoch k ,
Step 2-4-2: updating the current epoch observed value, namely performing weighted correction by using the weight of the current epoch measured value,
step 2-4-3: and updating the time, namely predicting the observed value of the next epoch.
In this embodiment, the specific process of robust Kalman adaptive filtering estimation is as follows:
in order to control the influence of the dynamic model abnormity and the observation abnormity, the robust estimation principle is adopted, the influence of the observation value abnormity is reduced or eliminated by selecting proper equivalent weight instead of an observation noise covariance matrix, and the influence of the dynamic model abnormity on the filtering solution is controlled by adjusting the proportion of the covariance matrix of the predicted value and the observation noise covariance matrix by using the adaptive factor. The robust adaptive Kalman filter solution is:
in the formula (I), the compound is shown in the specification,is L k Is an adaptive estimate of the observation vector weight matrix, alpha k Alpha is 0-alpha for the adaptive factor k ≤1;
Then, determining an equivalent weight factor and an adaptive weight factor, wherein the specific calculation process of the equivalent weight factor is as follows:
in BDS/GPS/GLONASS/GALILEO fusion positioning, the observed values among systems are independent, and the corresponding equivalence weights are as follows:
in the formula, P i Is the original weight matrix, w i Is an adaptive weight factor;
determining the weight factor by adopting an IGGIII equivalent weight factor-based function or a two-factor equivalent weight factor-based function, wherein the function expression based on the IGGIII equivalent weight factor is as follows:
in the formula (I), the compound is shown in the specification,to normalize the residual, k 1 、k 2 Is a constant, typically take k 1 =1.5~2.0,k 2 =3.0~8.0;
The function expression based on the two-factor equivalent weight factor is as follows:
wherein c is a constant, c is 2.5-3.0, and i and j represent row and column numbers of the matrix;
For GNSS multi-system fusion positioning, due to the difference of the precision of observed values of different systems, the residual vector of the observed values may have system errors, and the variance factor sigma v And the consistency is that the residual error information of the gross error and the correct observation values of different types cannot be accurately distinguished during the weight reduction processing of the adaptive factors. Normalized residual error for different types of observationsComprises the following steps:
the specific calculation process of the adaptive weight factor is as follows:
the dynamic model prediction innovation is that the state innovation of the current moment and a covariance matrix weighted gain matrix are updated by using the state estimation value of the previous moment and the observation value of the current moment, and the self-adaptive factor obtained based on the statistic of the innovation residual error structure can better reflect the disturbance condition of the dynamic system. Meanwhile, in order to fully utilize the kinetic model information, avoid a k In case of 0, the adaptive weight factor function is a two-stage function, that is:
wherein c is a constant, c is 1.0 to 2.5,
in the formula (I), the compound is shown in the specification,in order to normalize the prediction residual error,the residual is predicted for the state parameters,the trace of the residual covariance matrix is predicted for the state parameters.
In this embodiment, the Helmert variance component estimation adaptively adjusts the weight ratio between different types or unequal precision observation values through iterative computation, so that the weight distribution is more reasonable. The specific idea is that the initial weight of each kind of observation value is determined according to the experience value, the adjustment is carried out, the difference before the test of each kind of observation value is estimated according to the posterior residual error of the posterior observation value of the adjustment, the weight between each kind of observation value is obtained, and the adjustment is carried out again until the given test condition is satisfied. Performing Helmert variance component estimation according to the established BDS/GPS/GLONASS/GLILEO multi-system double-difference error equation and the prior weight ratio of each system observation value, wherein the specific calculation process comprises the following steps:
step 4-1: during the first filtering, the BDS, GPS, GLONASS and GLILEO observed values are firstly verified according to the altitude angle of the satellite to obtain the weight P C :P G :P R :P E ;
Step 4-2: performing filtering calculation to obtain V i T P i V i (i=C,G,R,E);
Step 4-3: and (3) carrying out variance component estimation:
in the formula (I), the compound is shown in the specification,
N=A T PA=A C T P C A C +A G T P G A G +A R T P R A R +A E T P E A E =N C +N G +N R +N E
wherein n is C 、n G 、n R And n E The numbers of BDS, GPS, GLONASS and GALILEO observed values respectively;
step 4-4: re-weighting:
When iteration is not converged or convergence distortion occurs in the step 4, the analysis reason is that the number of various observation values is unbalanced, and if the number of one kind of observation values is too small, the weight ratio determined by Helmert variance component estimation is easy to distort; secondly, in the observation data preprocessing process, if the difference of the residuals of various observation values is too large, the iteration process may have unconvergence or too many iteration times, and the S matrix is a singular matrix and cannot be positioned and solved. Therefore, in the resolving process, attention needs to be paid to various satellite numbers in the epoch to determine whether Helmert variance component estimation is adopted or not; when the iterative process diverges, the residual errors of all the satellites need to be analyzed, the satellites are screened again or the weights of some satellites are reduced properly, and then calculation is carried out.
In this embodiment, the BDS/GPS/GLONASS/glieo multi-system RTK Ambiguity fixing is preferably performed by using an lamb-square Ambiguity correction (Least-squares Ambiguity correction) method in combination with a partial Ambiguity fixing strategy. The method of lamb-square Ambiguity resolution Adjustment belongs to the prior art, and the fixing in combination with the partial Ambiguity fixing strategy is easy to be realized by those skilled in the art, and the present embodiment merely gives such a preferable mode.
Although the invention has been described in detail above with reference to a general description and specific examples, it will be apparent to one skilled in the art that modifications or improvements may be made thereto based on the invention. Accordingly, such modifications and improvements are intended to be within the scope of the invention as claimed.
Claims (10)
1. A GNSS multi-system robust adaptive fusion RTK resolving method is characterized by comprising the following steps:
step 1: establishing a conventional RTK double-difference observation equation according to BDS/GPS/GLONASS/GLILEO multi-system observation data of the base station and the rover station;
and 2, step: conventional Kalman filtering solution;
and 3, step 3: robust Kalman adaptive filtering estimation;
and 4, step 4: the estimation of Helmert variance component is fused in the BDS/GPS/GLONASS/GLILEO multi-system;
and 5: BDS/GPS/GLONASS/GLILEO multisystem RTK ambiguity fix.
2. The GNSS multi-system robust adaptive fusion RTK solution method according to claim 1, characterized in that the specific process of step 1 is as follows:
step 1-1: establishing a basic observation equation based on the non-difference original pseudo-range and the carrier phase observation value, which comprises the following steps:
in the formula, subscripts i and r are frequency and station survey of observed quantity respectively, and superscript j is a satellite;respectively, a pseudo range and a carrier phase original observed value, taking meters as a unit,as phase observations (weeks);geometric distance from satellite to station at the moment of signal transmission, c speed of light in vacuum, dt r And dt j Respectively receiver clock error and satellite clock error, T j In order to delay the tropospheric delay,is the ionospheric delay at the frequency i,andreceiver-side and satellite-side pseudorange hardware delay biases,andphase hardware delay biases including carrier phase hardware delay bias and initial phase bias, λ, at the receiver end and at the satellite end, respectively i Andcarrier phase wavelength at frequency i and integer ambiguity,andthe measurement noise is respectively the pseudo range and the carrier phase observation value;
step 1-2: according to the RTK double-difference model, the satellite clock difference and the receiver clock difference in the step 1-1 can be eliminated, the influences of satellite orbit errors, troposphere delay errors, ionosphere delay errors, multipath effects and the like are weakened, and a carrier phase double-difference observation equation is established, which specifically comprises the following steps:
in the formula, superscripts j and k represent satellite numbers; the r, b subscripts denote rover and reference stations;the observation value of the double-difference phase of the epoch t is obtained;the distance from the satellite s to the survey station r;is double-difference ambiguity; since the reference coordinates are known, the above equation can be converted into:
step 1-3: the prior coordinate of the rover station adopts single-point positioning estimation to approximate an estimated value X r =(x r ,y r ,z r ) T Let its correction number be δ X r =(δx r ,δy r ,δz r ) T And linearizing the equation finally converted in the step 1-2 to obtain a carrier phase double-difference error equation:
similarly, a pseudorange double difference error equation may be obtained:
3. The GNSS multi-system robust adaptive fusion RTK solution method according to claim 2, characterized in that the specific process of step 2 is as follows:
step 2-1: establishing a Kalman filtering state equation and an observation equation:
X k =Φ k,k-1 X k-1 +W k-1
L k =A k X k +V k
wherein k represents an observation epoch time, X k Representing the state vector at time k, phi k,k-1 A transition matrix, W, representing the state of the system from time k-1 to time k k-1 Is a dynamic noise vector, L k For the observation vector at time k, A k For observing the coefficient matrix of the equation, V k To observe the noise vector;
step 2-2: the observed values are regarded as mutually independent, and the dynamic noise and the observed noise are white noises which are zero-mean and mutually uncorrelated, namely the following conditions are met:
in the formula, omega k Is an array of variances of process noise, Q k A variance matrix for the observed noise;
step 2-3: and respectively rewriting the state equation and the observation equation into error equations:
in the formula (I), the compound is shown in the specification,and V k Respectively predicting values for state parametersAnd the observed value L k Residual vector of (2), and state parameter prediction valueComprises the following steps:
constructing an objective function according to a least square criterion:
in the formula, P k Andrespectively are observed values L k And state parameter preReporting valueIs expressed as
further, the method can be obtained as follows:
step 2-4: substituting an error equation corresponding to the observation equation into the formula (1) to obtain:
4. the GNSS multi-system robust adaptive fusion RTK solution method according to claim 3, characterized in that the general process of further deriving Kalman filtering calculation from matrix identity transformation and matrix inversion formula is:
step 2-4-1: calculating a Kalman filtering gain matrix K according to the prediction precision of the current epoch by the previous epoch k ,
Step 2-4-2: updating the current epoch observed value, namely performing weighted correction by using the weight of the current epoch measured value,
step 2-4-3: and updating the time, namely predicting the observation value of the next epoch.
5. The GNSS multi-system robust adaptive fusion RTK solution method according to claim 3 or 4, characterized in that the specific process of the step 3 is as follows:
step 3-1: the robust adaptive Kalman filter solution is:
in the formula (I), the compound is shown in the specification,is L k Is an adaptive estimate of the observation vector weight matrix, alpha k Alpha is 0-alpha for the adaptive factor k ≤1;
Step 3-2: equivalent weight factors and adaptive weight factors are determined.
6. The GNSS multi-system robust adaptive fusion RTK solution method according to claim 5, wherein the specific calculation process of the equivalent weight factors is as follows:
step 3-2-1: in BDS/GPS/GLONASS/GALILEO fusion positioning, the observed values among systems are independent, and the corresponding equivalence weights are as follows:
in the formula, P i Is the original weight matrix, w i Is an adaptive weight factor;
step 3-2-2: determining the weight factor by adopting an IGGIII equivalent weight factor-based function or a two-factor equivalent weight factor-based function, wherein the function expression based on the IGGIII equivalent weight factor is as follows:
in the formula (I), the compound is shown in the specification,to normalize the residual, k 1 、k 2 Is a constant, typically take k 1 =1.5~2.0,k 2 =3.0~8.0;
The function expression based on the two-factor equivalent weight factor is as follows:
wherein c is a constant, c is 2.5-3.0, and i and j represent row and column numbers of the matrix;
Step 3-2-4: normalized residual error for different types of observationsComprises the following steps:
7. the GNSS multi-system robust adaptive fusion RTK solution method according to claim 5, wherein the specific calculation process of the adaptive weight factor is as follows:
calculating adaptive weight factor a by using two-segment function k Namely:
wherein c is a constant, c is 1.0 to 2.5,
8. The GNSS multi-system robust adaptive fusion RTK solution method according to claim 5, wherein the specific process of step 4 is as follows:
step 4-1: during the first filtering, the BDS, GPS, GLONASS and GLILEO observed values are firstly verified according to the altitude angle of the satellite to obtain the weight P C :P G :P R :P E ;
Step 4-2: performing filtering calculation to obtain V i T P i V i (i=C,G,R,E);
Step 4-3: and (3) carrying out variance component estimation:
in the formula (I), the compound is shown in the specification,
N=A T PA=A C T P C A C +A G T P G A G +A R T P R A R +A E T P E A E =N C +N G +N R +N E
wherein n is C 、n G 、n R And n E The numbers of BDS, GPS, GLONASS and GALILEO observed values respectively;
step 4-4: re-weighting:
9. The GNSS multi-system robust adaptive fusion RTK solution method of claim 8, wherein when iteration non-convergence or convergence distortion occurs in step 4, the satellites are rescreened or the weights of some satellites are reduced appropriately, and then the solution is performed.
10. The GNSS multi-system robust adaptive fusion RTK solution method of claim 1, wherein in the step 5, the BDS/GPS/GLONASS/GLILEO multi-system RTK ambiguity fix is fixed by using least square ambiguity downcorrelation adjustment and partial ambiguity fix strategy.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210405810.XA CN114859389A (en) | 2022-04-18 | 2022-04-18 | GNSS multi-system robust adaptive fusion RTK resolving method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210405810.XA CN114859389A (en) | 2022-04-18 | 2022-04-18 | GNSS multi-system robust adaptive fusion RTK resolving method |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114859389A true CN114859389A (en) | 2022-08-05 |
Family
ID=82630482
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210405810.XA Pending CN114859389A (en) | 2022-04-18 | 2022-04-18 | GNSS multi-system robust adaptive fusion RTK resolving method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114859389A (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115220078A (en) * | 2022-08-24 | 2022-10-21 | 长沙金维信息技术有限公司 | GNSS high-precision positioning method and navigation method based on carrier phase difference |
CN115390096A (en) * | 2022-08-29 | 2022-11-25 | 浙江大学 | Low-orbit satellite real-time relative orbit determination method based on full-view satellite-borne GNSS (Global navigation satellite System) receiving system |
CN115755103A (en) * | 2022-11-15 | 2023-03-07 | 中国矿业大学(北京) | Robust self-adaptive GNSS (Global navigation satellite System) water vapor chromatography method |
CN115900527A (en) * | 2023-01-06 | 2023-04-04 | 中南大学 | Deformation monitoring method based on GNSS system error recursion semi-parameter modeling |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104714244A (en) * | 2015-03-31 | 2015-06-17 | 东南大学 | Multi-system dynamic PPP resolving method based on robust self-adaption Kalman smoothing |
EP3009860A1 (en) * | 2014-10-16 | 2016-04-20 | GMV Aerospace and Defence S.A. | Method for computing an error bound of a Kalman filter based GNSS position solution |
WO2019144528A1 (en) * | 2018-01-29 | 2019-08-01 | 东南大学 | Fast ambiguity resolving method among multi-constellation reference stations based on ambiguity tight constraint and application thereof |
CN110109158A (en) * | 2019-05-08 | 2019-08-09 | 广西壮族自治区基础地理信息中心 | Subsequent supper-fast RTK location algorithm based on GPS, GLONASS and BDS multisystem |
WO2019228439A1 (en) * | 2018-06-01 | 2019-12-05 | 浙江亚特电器有限公司 | Gnss-rtk-based positioning method |
CN111505685A (en) * | 2020-04-15 | 2020-08-07 | 中国科学院国家授时中心 | Positioning method of multisystem combination RTK model based on correcting intersystem deviation |
CN113359170A (en) * | 2021-06-04 | 2021-09-07 | 南京航空航天大学 | Inertial navigation-assisted Beidou single-frequency-motion opposite-motion high-precision relative positioning method |
CN113805212A (en) * | 2021-09-26 | 2021-12-17 | 南宁桂电电子科技研究院有限公司 | Self-adaptive GNSS carrier phase differential landslide monitoring method |
CA3131969A1 (en) * | 2020-10-01 | 2022-04-01 | IFP Energies Nouvelles | Method for determining average wind speed with a laser remote sensing sensor |
-
2022
- 2022-04-18 CN CN202210405810.XA patent/CN114859389A/en active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3009860A1 (en) * | 2014-10-16 | 2016-04-20 | GMV Aerospace and Defence S.A. | Method for computing an error bound of a Kalman filter based GNSS position solution |
CN104714244A (en) * | 2015-03-31 | 2015-06-17 | 东南大学 | Multi-system dynamic PPP resolving method based on robust self-adaption Kalman smoothing |
WO2019144528A1 (en) * | 2018-01-29 | 2019-08-01 | 东南大学 | Fast ambiguity resolving method among multi-constellation reference stations based on ambiguity tight constraint and application thereof |
WO2019228439A1 (en) * | 2018-06-01 | 2019-12-05 | 浙江亚特电器有限公司 | Gnss-rtk-based positioning method |
CN110109158A (en) * | 2019-05-08 | 2019-08-09 | 广西壮族自治区基础地理信息中心 | Subsequent supper-fast RTK location algorithm based on GPS, GLONASS and BDS multisystem |
CN111505685A (en) * | 2020-04-15 | 2020-08-07 | 中国科学院国家授时中心 | Positioning method of multisystem combination RTK model based on correcting intersystem deviation |
CA3131969A1 (en) * | 2020-10-01 | 2022-04-01 | IFP Energies Nouvelles | Method for determining average wind speed with a laser remote sensing sensor |
CN113359170A (en) * | 2021-06-04 | 2021-09-07 | 南京航空航天大学 | Inertial navigation-assisted Beidou single-frequency-motion opposite-motion high-precision relative positioning method |
CN113805212A (en) * | 2021-09-26 | 2021-12-17 | 南宁桂电电子科技研究院有限公司 | Self-adaptive GNSS carrier phase differential landslide monitoring method |
Non-Patent Citations (10)
Title |
---|
SANAT K.BISWAS等: "Effect of PDOP on performance of Kalman Filters for GNSS-based space vehicle position estimation", GPS SOLUTIONS, vol. 21, 4 April 2017 (2017-04-04), XP036261698, DOI: 10.1007/s10291-017-0621-x * |
何正斌: "GPS/INS组合导航数据处理算法拓展研究", 信息技术辑, no. 7, 15 July 2013 (2013-07-15), pages 008 - 4 * |
侯燕青: "多卫星导航系统RTK定位部分整周模糊度解算方法研究", 基础科学辑, no. 1, 15 January 2019 (2019-01-15), pages 008 - 24 * |
张菊清: "双因子抗差贝叶斯估计及其在GIS数据采集质量控制中的应用", 测绘工程, vol. 15, no. 6, 31 December 2006 (2006-12-31) * |
李成成等: "基于Helmert方差分量估计的GPS/BDS组合系统定权方法研究", 勘察科学技术, no. 3, 31 March 2019 (2019-03-31), pages 11 - 15 * |
田源;隋立芬;刘长建;王凌轩;陈泉余;田翌君;: "观测卫星不足时的GPS/INS紧组合抗差自适应滤波", 测绘科学技术学报, no. 2, 31 December 2017 (2017-12-31) * |
赵庆海: "高精度GPS向量网抗差估计", 测绘学报, vol. 33, no. 1, 28 February 2004 (2004-02-28) * |
马丹等: "复杂环境下的GPS/BDS/GLONASS结合的单频RTK定位性能研究", 华中师范大学学报(自然科学版), vol. 51, no. 2, 30 April 2017 (2017-04-30), pages 253 - 272 * |
高晓;戴吾蛟;张超;余文坤;: "多星座组合精密动态定位的抗差扩展Kalman滤波方法研究", 武汉大学学报(信息科学版), vol. 40, no. 10, 31 October 2015 (2015-10-31) * |
龙新: "多系统融合精密单点定位模糊度算法研究", 基础科学辑, no. 5, 15 May 2019 (2019-05-15), pages 008 - 99 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115220078A (en) * | 2022-08-24 | 2022-10-21 | 长沙金维信息技术有限公司 | GNSS high-precision positioning method and navigation method based on carrier phase difference |
CN115390096A (en) * | 2022-08-29 | 2022-11-25 | 浙江大学 | Low-orbit satellite real-time relative orbit determination method based on full-view satellite-borne GNSS (Global navigation satellite System) receiving system |
CN115390096B (en) * | 2022-08-29 | 2023-04-25 | 浙江大学 | Low-orbit satellite real-time relative orbit determination method based on full-view satellite-borne GNSS receiving system |
CN115755103A (en) * | 2022-11-15 | 2023-03-07 | 中国矿业大学(北京) | Robust self-adaptive GNSS (Global navigation satellite System) water vapor chromatography method |
CN115900527A (en) * | 2023-01-06 | 2023-04-04 | 中南大学 | Deformation monitoring method based on GNSS system error recursion semi-parameter modeling |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Paziewski et al. | Assessment of GPS+ Galileo and multi-frequency Galileo single-epoch precise positioning with network corrections | |
CN114859389A (en) | GNSS multi-system robust adaptive fusion RTK resolving method | |
Zhang et al. | An improved robust adaptive Kalman filter for GNSS precise point positioning | |
RU2479855C2 (en) | Distance dependant error mitigation in real-time kinematic positioning | |
EP2985631B1 (en) | Navigation satellite system based positioning involving the generation of receiver-specific or receiver-type-specific correction information | |
US20220107427A1 (en) | System and method for gaussian process enhanced gnss corrections generation | |
US20170269225A1 (en) | Navigation Satellite Wide-Lane Bias Determination and Over-Range Adjustment System and Method | |
Yang et al. | Generalised DOPs with consideration of the influence function of signal-in-space errors | |
CN107966722B (en) | GNSS clock error resolving method | |
CN115373005A (en) | High-precision product conversion method between satellite navigation signals | |
Duong et al. | An optimal linear combination model to accelerate PPP convergence using multi-frequency multi-GNSS measurements | |
Bahadur et al. | Integration of variance component estimation with robust Kalman filter for single-frequency multi-GNSS positioning | |
CN115480279A (en) | GNSS navigation method and terminal, integrated navigation system and storage medium | |
CN115220078A (en) | GNSS high-precision positioning method and navigation method based on carrier phase difference | |
CN116953741A (en) | Cycle slip detection and repair method applied to global navigation satellite system GNSS | |
CN113671551B (en) | RTK positioning calculation method | |
Zhang et al. | A resilient adjustment method to weigh pseudorange observation in precise point positioning | |
CN114355410B (en) | Satellite navigation real-time precise single-point positioning system and method based on parallel computing | |
Gaglione et al. | Robust Kalman Filter applied to GNSS positioning in harsh environment | |
CN115436977A (en) | Method for processing inter-frequency deviation of pseudo range in GLONASS system | |
CN110941002B (en) | Self-adaptive anti-difference sequential least square precise point positioning method | |
Carcanague et al. | A new algorithm for GNSS precise positioning in constrained area | |
Zhilinskiy | GLONASS Satellite Pseudorange Errors Mitigation Using Gradient Boosting Machine | |
Du et al. | A method for PPP ambiguity resolution based on Bayesian posterior probability | |
CN118091718B (en) | Method for improving UT1 calculation accuracy through low orbit satellite downlink navigation signal |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |