Satellite navigation and inertial navigation combined positioning method, device and system
By combining multi-antenna GNSS and inertial navigation systems in urban environments, using IMU-assisted multi-antenna RTK observation equation system and baseline vector constraints, the problems of GNSS signal occlusion and inertial navigation error accumulation are solved, and high-precision and reliable positioning are achieved Output, suitable for autonomous driving and precision measurement in complex environments.
Patent Information
- Application Number
- CN202411068189.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-05
- Publication Date
- 2024-11-22
AI Technical Summary
In complex urban environments, the occlusion and reflection of GNSS signals lead to a decrease in positioning accuracy and reliability. The accumulation of errors and high costs of inertial navigation systems limit the application of high-precision navigation.
Using a combined positioning method of multi-antenna GNSS and inertial measurement unit (IMU) combined, the RTK observation equations of IMU-assisted multi-antenna multi-receiver are constructed, and real-time difference is performed using the geometric relationship between multiple antennas and the attitude angle information provided by IMU. Positioning and baseline vector constraints, detect abnormal observations, and improve positioning accuracy and reliability.
It significantly improves positioning accuracy and reliability in complex environments, can maintain high-precision positioning output when the GNSS signal is blocked, enhances the system's anti-interference ability and positioning continuity, and is suitable for applications such as autonomous driving and precision measurement.
Smart Images

Figure CN119001804A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to the field of satellite positioning technology, and in particular to a combined positioning method, device and system of satellite navigation and inertial navigation. Background Art
[0002] With the rapid development of emerging applications such as autonomous driving and drones, the demand for high-precision navigation is growing. Especially in complex urban environments, the robust high-precision positioning capability of the Global Navigation Satellite System (GNSS) faces severe challenges.
[0003] At present, the Real-Time Kinematic (RTK) technology based on GNSS carrier phase has been widely used in surveying and mapping, deformation monitoring and other fields. RTK technology can achieve centimeter-level or even millimeter-level positioning accuracy by providing continuous and stable pseudorange and carrier phase observations by GNSS receivers. However, in urban environments, high-rise buildings, trees and other obstructions will block or reflect satellite signals, resulting in a decrease in the quality of satellite signal reception, multipath effects and signal fading, which in turn affects the accuracy and reliability of positioning.
[0004] As an autonomous navigation system, the Inertial Navigation System (INS) does not rely on external signals, so it has unique advantages in urban navigation. INS measures the motion information of the carrier through the internal gyroscope and accelerometer, and calculates the position through integration. However, INS also has some limitations, such as long-term integration will lead to error accumulation, affecting navigation accuracy. In addition, INS takes a long time for initial alignment, and the equipment cost is relatively high.
[0005] In order to overcome the shortcomings of a single navigation system, researchers have been working on the integrated use of GNSS and INS.
[0006] In the field of basic navigation, researchers have studied the combination of a single antenna single receiver and an inertial measurement unit (IMU). However, in terms of high-precision positioning, especially after the emergence of satellite multi-antenna positioning algorithms, how to use IMU information and multi-antenna observations to improve the robust high-precision positioning performance in complex observation environments needs further research. Summary of the invention
[0007] The disclosed embodiment proposes a combined positioning technology of satellite navigation and inertial navigation, which can make full use of multi-antenna GNSS observation data and IMU data, and is of great significance for improving positioning accuracy and reliability in complex environments such as urban areas.
[0008] According to an embodiment of the present disclosure, a satellite navigation and inertial navigation combined positioning method is proposed, comprising:
[0009] Obtaining observations of multiple receivers of multiple antennas at the user end and observations of the reference station, wherein at least one of the antennas is connected to at least two of the receivers via a power divider to form a zero baseline configuration;
[0010] Obtain the speed, position and attitude angle information of the user-side carrier provided by the inertial measurement unit (IMU);
[0011] Based on the observations of the multiple receivers and the observations of the reference station, the speed, the position and the attitude angle information provided by the IMU, construct an IMU-assisted multi-antenna multi-receiver real-time differential positioning (RTK) observation equation group;
[0012] Solving the IMU-assisted multi-antenna multi-receiver RTK observation equations to obtain an RTK fixed solution;
[0013] Using the geometric relationship between receivers, the RTK fixed solution is verified through coordinate closure constraints and ambiguity closure constraints;
[0014] Use the short-term continuity of the position obtained by the IMU to detect outliers in the RTK fixed solution;
[0015] Based on the inspection results, the user terminal positioning information is output.
[0016] In some implementations, constructing an IMU-assisted multi-antenna multi-receiver RTK observation equation set includes:
[0017] Establishing an RTK observation equation of a baseline formed by the receiver of the user end and the reference station;
[0018] Establishing the baseline length observation equation based on the pre-measured inter-antenna distance constraint;
[0019] Establishing a baseline vector observation equation formed based on the attitude angle information and the baseline length;
[0020] The baseline vector triangle closure error observation equation based on the closed loop constraint of multiple receivers is established.
[0021] In some implementations, establishing an RTK observation equation of a baseline formed by the receiver of the user terminal and the reference station includes:
[0022] The RTK observation equation of the baseline formed by the receiver of the user end and the reference station is established based on the following formula:
[0023] H a x = l a +ε,
[0024] Among them, H a is the linearization matrix, l a is the linearized observation residual matrix, x is the result to be estimated, x includes the position coordinates of the receiver connected to the antenna relative to the reference station and the corresponding double difference ambiguity, and ε is the observation noise.
[0025] In some embodiments, establishing a baseline length observation equation based on pre-measured inter-antenna distance constraints includes:
[0026] The baseline length observation equation is established based on the following formula:
[0027] H e ·[r r3,b -r r1,b N r3,r1 ] T =d r3,r1 +ε e ,
[0028] Among them, r1 and r3 are two receivers connected to different antennas, b is the reference station, are the position coordinates of receivers r1 and r3 relative to the base station b in the RTK floating point solution, n is the number of double difference observations, and r r1,b 、r r3,b are the position coordinates of the receivers r1 and r3 to be estimated relative to the reference station b, N r3,r1 is the integer ambiguity of receiver r1 relative to receiver r3, d r3,r1 is the pre-measured distance between the two antennas connecting the receivers r1 and r3, ε e is the measurement error of the distance between the two antennas.
[0029] In some implementations, establishing a baseline vector observation equation based on the attitude angle information and the baseline length includes:
[0030] The baseline vector observation equation is established based on the following formula:
[0031] H c ·[r r3,b -r r1,b N r3,r1 ] T =XYZ r3,r1 +ε c ,
[0032] Among them, r1 and r3 are two receivers connected to different antennas, b is the reference station, H c =[I 3×3 0 n×n ], I is the identity matrix, r r3,b 、r r1,b are the position coordinates of the receivers r3 and r1 to be estimated relative to the reference station b, XYZ r3,r1 is the relative position of the receiver r3 to r1 obtained based on the attitude angle information provided by the IMU, ε c is the measurement error of the relative position.
[0033] In some embodiments, the method further comprises:
[0034] The baseline vector NEU from receiver r3 to r1 in the North East Sky Coordinate System (NEU) is obtained based on the following formula: r3,r1 :
[0035] NEU r3,r1 =d r3,r1 *[cos(y)cos(p) sin(y)cos(p) sin(p)] T ,
[0036] Among them, d r3,r1 is the pre-measured distance between the two antennas connecting the receivers r1 and r3, y is the azimuth angle in the attitude angle information, and p is the pitch angle in the attitude angle information;
[0037] By the latitude and longitude of the carrier coordinates, NEU r3,r1 Convert to the XYZ coordinate system used by satellite positioning to obtain the position coordinates XYZ of the receiver r3 to r1 in the XYZ coordinate system r3,r1 .
[0038] In some implementations, a baseline vector triangle closure error observation equation based on a closed loop constraint formed by multiple receivers is established:
[0039] The baseline vector triangle closure error observation equation is established based on the following formula:
[0040]
[0041] Among them, r1, r2, r3 are all receivers connected to the antenna and three receivers in the reference station, H d =[I -I -I], I is the identity matrix, are the position coordinates of receiver r1 relative to receiver r2, the position coordinates of receiver r3 relative to receiver r2, and the position coordinates of receiver r1 relative to receiver r3 in the RTK floating point solution, εd is the RTK floating point solution estimation error.
[0042] In some embodiments, validating the RTK fixed solution using coordinate closure constraints includes:
[0043] The RTK fixed solution is verified based on the following coordinate closure constraints:
[0044]
[0045] Among them, r1 and r3 are two receivers connected to the antenna, b is the reference station, is the position coordinate of the receiver r1 relative to the base station in the RTK fixed solution, is the position coordinate of the receiver r3 relative to the base station in the RTK fixed solution, is the position coordinate of receiver r1 relative to receiver r3 in the RTK fixed solution, ε f is the estimated error of the preset RTK fixed solution;
[0046] Verification of the RTK fixed solution through ambiguity closure constraints includes:
[0047] The ambiguity terms corresponding to the RTK fixed solution are verified based on the following ambiguity closure constraints:
[0048]
[0049] Among them, r1 and r3 are two receivers connected to the antenna, b is the reference station, They are the double difference ambiguity of receiver r1 and base station b to satellite j and satellite k, the double difference ambiguity of receiver r3 and base station b to satellite and satellite k, and the double difference ambiguity of receiver r1 and receiver r3 to satellite and satellite k in the RTK fixed solution.
[0050] In some embodiments, the short-term continuity of the position obtained by the IMU is used to detect outliers in the RTK fixed solution, including:
[0051] Set a sliding time window;
[0052] Taking the position coordinates of the RTK fixed solution at the starting point of the current time window as the reference point, starting from the reference point, the relative position change at each moment in the current time window is obtained based on the IMU integration;
[0053] Based on the reference point and the relative position change, the position predicted by the IMU at each moment in the current time window is obtained;
[0054] Compare the position predicted by the IMU at each moment in the current time window with the position coordinates of the RTK fixed solution at the corresponding moment to detect outliers in the RTK fixed solution.
[0055] In some embodiments, before constructing the IMU-assisted multi-antenna multi-receiver RTK observation equation group, the method further includes detecting abnormal observations using zero-baseline double-difference observations by the following steps:
[0056] The zero baseline double difference pseudorange observation ZDO is calculated based on the following formula P and zero baseline double difference carrier phase observation ZDO φ :
[0057]
[0058] Among them, r1 and r2 are two receivers connected to the same antenna, is the double difference of pseudorange observations of satellites j and k from receivers r1 and r2, is the noise of the pseudorange double-difference observations, is the double difference observation of the carrier phase of satellites j and k by receivers r1 and r2, is the double-difference ambiguity of the carrier phase of receivers r1 and r2 to satellites j and k, is the noise of the carrier phase double difference observation;
[0059] If the calculated zero baseline double difference pseudorange observation ZDO P If the absolute value of exceeds the zero baseline pseudorange deviation threshold, the zero baseline double difference pseudorange observation ZDO is judged to be P There are anomalies in the related observations;
[0060] If the calculated zero baseline double-difference carrier phase observation ZDO φ If there is a full cycle jump, a half cycle jump, or exceeds the zero baseline carrier phase deviation threshold, the zero baseline double difference carrier phase observation ZDO is determined. φ There are anomalies in the related observations.
[0061] In some implementations, the zero-baseline pseudorange deviation threshold is 0.6 m, and / or the zero-baseline carrier phase deviation threshold is 10% of the carrier phase wavelength.
[0062] In some implementations, based on the inspection result, outputting the user terminal location information includes:
[0063] If the RTK fixed solution passes the verification, outputting the RTK fixed solution as the user terminal positioning information;
[0064] If the RTK fixed solution is verified to be an outlier, the position obtained by the IMU is output as the user-side positioning information.
[0065] In some embodiments, the IMU is a fiber optic inertial measurement unit or a microelectromechanical (MEMS) inertial measurement sensor.
[0066] According to one embodiment of the present disclosure, a satellite navigation and inertial navigation combined positioning system is also proposed. The system is arranged at a user end and includes multiple antennas, at least one power divider, multiple receivers, an inertial measurement unit (IMU), a communication module and a data processing module, wherein:
[0067] The antenna is used to receive satellite signals;
[0068] The receiver is connected to the antenna and is used to process the satellite signal to obtain an observed quantity, wherein at least one of the antennas is connected to at least two receivers via the corresponding power divider to form a zero baseline configuration;
[0069] The communication module is used to receive the observation value of the reference station;
[0070] The IMU is used to obtain the speed, position and attitude angle information of the user-side carrier based on the measurement data;
[0071] The data processing module is connected to the multiple receivers, the IMU and the communication module, and is used to execute the method described in any of the above embodiments based on the observations of the receivers, the observations of the reference station and the speed, position and attitude angle information provided by the IMU.
[0072] According to one embodiment of the present disclosure, a satellite navigation and inertial navigation combined positioning device is also proposed, comprising:
[0073] An observation acquisition unit, used to acquire observations of multiple receivers of multiple antennas at the user end and observations of the reference station, wherein at least one of the antennas is connected to at least two of the receivers via a power divider to form a zero baseline configuration;
[0074] An IMU information acquisition unit is used to obtain the speed, position and attitude angle information of the user-side carrier provided by an inertial measurement unit (IMU);
[0075] An observation equation group construction unit is used to construct an IMU-assisted multi-antenna multi-receiver real-time differential positioning (RTK) observation equation group based on the observation quantities of the multiple receivers and the observation quantities of the reference station, the speed, the position and the attitude angle information of the carrier;
[0076] An RTK solving unit, used for solving the IMU-assisted multi-antenna multi-receiver RTK observation equation group to obtain an RTK fixed solution;
[0077] The triangle closure constraint verification unit is used to verify the RTK fixed solution by using the geometric relationship between receivers through coordinate closure constraints and ambiguity closure constraints;
[0078] IMU short-time continuity verification unit, used to verify the outliers in the RTK fixed solution using the short-time continuity of the position obtained by the IMU;
[0079] The positioning output unit is used to output the user terminal positioning information based on the inspection result.
[0080] According to one embodiment of the present disclosure, an electronic device is also proposed, the device comprising a memory and a processor, the memory is used to store computer instructions executable on the processor, and the processor is used to implement the method described in any of the above embodiments when executing the computer instructions.
[0081] According to an embodiment of the present disclosure, a computer-readable storage medium is further provided, on which a computer program is stored. When the program is executed by a processor, the method described in any of the above embodiments is implemented.
[0082] The positioning solution of integrating multi-antenna multi-receiver RTK and inertial navigation proposed in the present disclosure, on the one hand, adopts multi-antenna multi-receiver, greatly increases the number of observations, and introduces more baseline length constraints and baseline vector triangle closure constraints, effectively enhancing the geometric strength of the positioning solution, and effectively detecting abnormal observations through zero baseline configuration; on the other hand, it further improves the accuracy and reliability of positioning by integrating the inertial measurement unit (IMU). The attitude angle information provided by the IMU not only provides additional constraints for the baseline vectors between antennas, but also maintains high-precision position information in a short time. This feature is particularly important when the GNSS signal is severely blocked or interfered, and can effectively make up for the shortcomings of satellite navigation. In addition, the short-term continuity of IMU data can also be used to detect wild values in RTK positioning, further improving the robustness of positioning, and improving the problem of insufficient observation differences of zero baseline receivers.
[0083] Through the deep integration of multi-antenna multi-receiver, zero baseline configuration and IMU, this solution not only improves the problem of insufficient available observations in complex observation environments, but also maintains continuous high-precision positioning output when satellite signals are temporarily lost. This innovative combined positioning method significantly improves positioning performance in complex environments such as cities, especially tree-lined roads, and provides more reliable and stable technical support for high-precision positioning applications such as autonomous driving and precision measurement. BRIEF DESCRIPTION OF THE DRAWINGS
[0084] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the specification and, together with the description, serve to explain the principles of the specification.
[0085] Figure 1 A flowchart of a satellite navigation and inertial navigation combined positioning method according to an embodiment of the present disclosure is shown;
[0086] Figure 2 A schematic diagram of a satellite navigation and inertial navigation combined positioning system according to an embodiment of the present disclosure is shown;
[0087] Figure 3 A satellite positioning schematic diagram showing a schematic diagram structure of a dual-antenna four-receiver RTK positioning and IMU integrated navigation system according to an exemplary embodiment of the present disclosure;
[0088] Figure 4 The RTK positioning process according to an exemplary embodiment of the present disclosure is shown;
[0089] Figure 5 A schematic diagram of a triangular closed loop formed by dual receivers and a reference station according to an exemplary embodiment of the present disclosure is shown;
[0090] Figure 6 A flow chart of a dual-antenna four-receiver RTK positioning and IMU combined positioning method according to an exemplary embodiment of the present disclosure is shown;
[0091] Figure 7 It is a schematic diagram of the structure of an electronic device shown in at least one embodiment of the present disclosure. DETAILED DESCRIPTION
[0092] Exemplary embodiments will be described in detail herein, examples of which are shown in the accompanying drawings. When the following description refers to the drawings, the same numbers in different drawings represent the same or similar elements unless otherwise indicated. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with the present disclosure. Instead, they are merely examples of devices and methods consistent with some aspects of the present disclosure as detailed in the appended claims.
[0093] The disclosed embodiments may be applied to a computer system / server that may operate with numerous other general or special computing system environments or configurations. Examples of well-known computing systems, environments, and / or configurations suitable for use with a computer system / server include, but are not limited to, personal computer systems, server computer systems, thin clients, thick clients, handheld or laptop devices, microprocessor-based systems, set-top boxes, programmable consumer electronics, networked personal computers, minicomputer systems, mainframe computer systems, and distributed cloud computing technology environments including any of the above systems, and the like.
[0094] Computer systems / servers may be described in the general context of computer system executable instructions (such as program modules) executed by a computer system. In general, program modules may include routines, programs, object programs, components, logic, data structures, etc., which perform specific tasks or implement specific abstract data types. Computer systems / servers may be implemented in a distributed cloud computing environment where tasks are performed by remote processing devices linked through a communication network. In a distributed cloud computing environment, program modules may be located on local or remote computing system storage media including storage devices.
[0095] Figure 1 A flow chart of a satellite navigation and inertial navigation combined positioning method according to an embodiment of the present disclosure is shown. As shown in the figure, the method includes steps 1 to 7.
[0096] Step 1: Obtain observations of multiple receivers of multiple antennas at the user end and observations of the reference station, wherein at least one of the antennas is connected to at least two receivers via a power divider to form a zero baseline configuration.
[0097] Usually, the observations mainly include pseudorange observations and carrier phase observations. Pseudorange is the distance obtained by multiplying the propagation time of the satellite signal by the speed of light measured by the receiver (the receiver of the user-side antenna or the base station). It contains the real distance from the satellite to the receiver and various errors, and its accuracy is relatively low. Carrier phase is the phase of the satellite signal carrier measured by the receiver (the receiver of the user-side antenna or the base station), usually in weeks, with high measurement accuracy, including unknown whole-cycle ambiguities, which can be resolved by specific algorithms.
[0098] Figure 2 A schematic diagram of a satellite navigation and inertial navigation combined positioning system according to an embodiment of the present disclosure is shown. Figure 2 The M (M is greater than or equal to 2) antennas of the user end shown can be deployed on vehicles such as self-driving cars and drones, where at least one antenna is connected to N (N is greater than or equal to 2) receivers through a power divider to form a zero baseline configuration. RTK differential data is provided by the base station and can be sent to the user end carrier through a communication network or radio. Figure 2 The user-side carrier shown is also provided with an IMU.
[0099] Figure 3 A satellite positioning schematic diagram is shown, showing a schematic diagram structure of a dual-antenna four-receiver RTK positioning and IMU integrated navigation system according to an exemplary embodiment of the present disclosure. Figure 3The user end shown in the figure is equipped with two antennas (a1, a2) and four receivers (r1, r2, r3, r4). Receivers r1 and r2 are connected to antenna a1 through a power divider to form a zero baseline configuration; similarly, receivers r3 and r4 are connected to antenna a2 through a power divider to form a zero baseline configuration. Figure 3 As shown, the combined positioning system according to the embodiment of the present disclosure also includes an IMU.
[0100] According to the multi-antenna multi-receiver satellite positioning of this embodiment, more observations can be obtained, which helps to improve positioning accuracy and reliability. The zero baseline structure enables the use of multiple receiver data of the same antenna for abnormal observation detection, and the multi-antenna structure also provides additional geometric constraints, which helps to improve the stability of positioning solution, as described later.
[0101] The number of antennas and receivers can be flexibly increased or decreased according to the structure of the actual carrier and the complexity of the observation environment. For example, when the observation environment is harsh, more antennas can be added to facilitate the subsequent formation of more baseline length observation equations and baseline vector triangle closure error constraints; more receivers can also be connected to a single antenna through a power divider to form multiple sets of zero baseline observations to enhance the detection capability of abnormal observations. At the same time, more zero baseline receivers can also obtain more observations and form more baseline vector triangle closure error constraints. By increasing the number of observation equations and providing more fixed solution test conditions, the RTK robust positioning capability in complex observation environments can be improved.
[0102] Theoretically, according to the law of error propagation, the more antennas and receivers there are, the greater the gain in RTK positioning performance. However, in actual applications, it is necessary to comprehensively consider the equipment cost, observation environment and carrier structure to make appropriate choices.
[0103] Step 2: Obtain the speed, position and attitude angle information of the user-side carrier provided by the inertial measurement unit (IMU).
[0104] like Figure 2 and Figure 3 According to the disclosed embodiment, the combined positioning system includes an IMU arranged on a user-side carrier.
[0105] IMU is an autonomous navigation device that usually contains a three-axis accelerometer and a three-axis gyroscope. The accelerometer measures the linear acceleration of the carrier, and the gyroscope measures the angular velocity. By integrating these measurement data, the speed, position and attitude angle information of the carrier can be obtained. The important features of IMU are its high accuracy and autonomy in a short period of time, and it can provide continuous navigation information without relying on external signals.
[0106] Step 3, constructing an IMU-assisted multi-antenna multi-receiver real-time differential positioning (RTK) observation equation group based on the observations of the multiple receivers and the reference station, the speed, position and attitude angle information provided by the IMU.
[0107] In some implementations, constructing an IMU-assisted multi-antenna multi-receiver RTK observation equation set includes:
[0108] Establishing an RTK observation equation of a baseline formed by the receiver of the user end and the reference station;
[0109] Establishing the baseline length observation equation based on the pre-measured inter-antenna distance constraint;
[0110] Establishing a baseline vector observation equation formed based on the attitude angle information constraint and the baseline length;
[0111] The baseline vector triangle closure error observation equation based on the closed loop constraint composed of multiple receivers is established.
[0112] The above-mentioned simultaneous observation equations are explained one by one through specific implementation methods below.
[0113] In satellite differential positioning, the observation equations of pseudorange and carrier phase can be expressed as:
[0114]
[0115] In formula (1), i and s are the receiver number and satellite number respectively; φ is the carrier phase observation in weeks; P is the pseudorange observation in meters; dt is the clock error; ρ is the distance from the satellite to the receiver; B is the hardware delay of the pseudorange; N is the carrier phase ambiguity; U is the uncalibrated delay of the carrier phase; λ is the carrier wavelength; I and T are the ionospheric delay and tropospheric delay respectively; ξ and ε are the observation noise of the pseudorange and carrier phase respectively.
[0116] In formula (1), the difference between the observations of the two receivers can eliminate the errors related to the satellite, the difference between the observations of the two satellites can eliminate the errors related to the receiver, and the difference between the observations of the two receivers and the two satellites (called double difference observations) can eliminate the errors related to the satellite and the receiver. When the distance between the two receivers is close (no more than 5km), the ionospheric delay and the tropospheric delay can also be approximately eliminated by receiver difference, and the final double difference observation equation is:
[0117]
[0118] Among them, r, b, j, and k are the numbers of the user terminal, base station, used satellite, and reference satellite respectively. and They are the double difference operator and the single difference operator respectively.
[0119] According to some embodiments, the geometric distance term in formula (2) is By linearly expanding the initial position of the user end, the following RTK observation equation of the baseline formed by the user end receiver and the base station can be established:
[0120] H a x = l a +ε, (3)
[0121] Among them, H a is the linearization matrix, l a is the linearized observation residual matrix, x is the result to be estimated, x includes the position coordinates of the receiver relative to the reference station and the corresponding double difference ambiguity, and ε is the observation noise.
[0122] by Figure 3 Taking the RTK observation equation of receiver r1 in as an example, H a It can be expressed as A is the coefficient matrix composed of satellite positions and user terminal positions, I is the unit matrix, and n is the number of double-difference observations; l a It can be expressed as l a =[λ·φ r1,b P r1,b ] T , is the linearized observation residual matrix; x = [r r1,b N r1,b ] T is the result to be estimated by RTK, including the position coordinates r of the receiver r1 relative to the base station b r1,b , and the double difference ambiguity N of receiver r1 relative to reference station b r1,b , taking satellite j and reference satellite k as an example, the corresponding double difference ambiguity is recorded as
[0123] The number of unknown parameters in formula (3) is (3+n), and 2n RTK observation equations such as formula (3) can be established. When the number of double-difference observations reaches 3 or more (i.e., n≥3), the least squares estimation is performed on formula (3). Taking receiver r1 as an example, the floating-point solution of x can be obtained. The carrier phase of a GNSS satellite usually has millimeter-level ranging accuracy, but when used, its phase integer ambiguity N must be accurately fixed. r1,b Considering that the ambiguity has integer characteristics, the integer search or integer transformation method can be used to obtain the integer solution of the carrier phase ambiguity N. The double difference ambiguity is integerized Substitute the RTK observation equation and recalculate to obtain high-precision position coordinates The corresponding x-fixed solution is RTK results with ambiguity fixed can usually achieve centimeter-level positioning accuracy.
[0124] The detailed exemplary RTK positioning process is as follows Figure 4 As shown in FIG. 1 , the receiver r1 and the base station b are still used as an example for explanation. Figure 4 As shown, the observations of the user-side receiver r1 and the reference station b can be obtained and preprocessed, such as time synchronization of the observations; then the observations of the single user-side receiver and the reference station are subtracted, and the observations of the two satellites are subtracted to obtain double-difference observations of pseudorange and carrier phase; the double-difference observation equation is obtained; RTK positioning is performed to estimate the RTK floating-point solution; the carrier phase double-difference ambiguity in the RTK floating-point solution is fixed by carrier phase integer ambiguity search and the like, to obtain the double-difference ambiguity fixed to an integer; the RTK fixed solution test is performed; and the RTK fixed solution that passes the final test is obtained.
[0125] The fixed solution test of the RTK observation equation can be carried out by using ratio test, residual test, consistency test of floating point solution and fixed solution, continuity test, etc. The ratio test usually compares the square sum residual ratio of the best integer ambiguity solution and the second best solution. If the residual ratio exceeds a certain threshold, the fixed solution is considered reliable. The residual test usually checks whether the observation residual of the fixed solution is within a reasonable range. If the residual is too large, it may indicate that the fixed solution is unreliable. The consistency test of floating point solution and fixed solution is used to compare the difference between the fixed solution and the floating point solution. If the difference is too large, it may indicate that the fixed solution is unreliable. The continuity test is used to check the consistency of the fixed solution between consecutive observation epochs. If the change is too large, it may indicate that the fixed solution is unstable.
[0126] In some embodiments, a baseline length observation equation based on pre-measured inter-antenna distance constraints may be established based on the following equation:
[0127] H e ·[r r3,b -r r1,b N r3,r1 ] T =d r3,r1 +ε e , (4)
[0128] Among them, r1 and r3 are two receivers connected to different antennas, b is the reference station, are the position coordinates of receivers r1 and r3 relative to the base station b in the RTK floating point solution, n is the number of double difference observations, and r r1,b 、r r3,bare the position coordinates of the receivers r1 and r3 to be estimated relative to the reference station b, N r3,r1 is the integer ambiguity of receiver r1 relative to receiver r3, d r3,r1 is the pre-measured distance between the two antennas connecting the receivers r1 and r3, ε e is the measurement error of the distance between the two antennas.
[0129] d r3,r1 It can be measured in advance by tools such as steel rulers. Usually, the baseline length error ε measured by steel rulers is e This error level is much smaller than the typical error of GNSS observations, so it can effectively improve the positioning results.
[0130] In a multi-antenna system according to this embodiment, the distance between different antennas is fixed, and this embodiment uses this information to enhance the geometric strength of the RTK solution. By formula (4), using the pre-measured antenna distance d r3,r1 To limit the relative position of the two receivers, it helps to maintain high positioning accuracy when satellite observation conditions are poor.
[0131] For Figure 3 In the dual-antenna four-receiver configuration shown, receivers r1 and r3, and receivers r2 and r4 can all establish the baseline length observation equation as shown in formula (4).
[0132] Considering that the IMU can provide directional information between antennas, in some embodiments of the present disclosure, the baseline vector NEU of the receiver r3 to r1 in the North East Sky Coordinate System (NEU) can be obtained based on the following formula: r3,r1 :
[0133] NEU r3,r1 =d r3,r1 *[cos(y)cos(p) sin(y)cos(p) sin(p)] T , (5)
[0134] Among them, d r3,r1 is the pre-measured distance between the two antennas connected to the receivers r1 and r3, y and p are the attitude angle information of the IMU in the antenna connection coordinate system, where y is the azimuth angle and p is the pitch angle;
[0135] By the latitude and longitude of the carrier coordinates, NEU r3,r1 Converted to the XYZ coordinate system used by satellite positioning, we can get the position coordinates XYZ of the receiver r3 to r1 in the XYZ coordinate system r3,r1 .
[0136] In some embodiments according to the present disclosure, the IMU pointing direction can be set to align with the antenna connection line (such as Figure 3 As shown); in some other embodiments according to the present disclosure, the IMU pointing is set to not align with the connection line between the antennas.
[0137] When the IMU is pointing to align with the line between the antennas, the attitude angle information output by the IMU can be directly used to calculate the baseline vector between the antennas. The data processing process is simple and the calculation efficiency is high. In some cases, due to carrier structure limitations or other reasons, the IMU is not set to align with the antenna line, and additional coordinate transformation processing can be performed on it. For example, the fixed rotation relationship between the IMU coordinate system and the antenna line coordinate system can be measured and recorded, and this rotation matrix can be applied during data processing to convert the attitude angle information provided by the IMU to the antenna line coordinate system.
[0138] In some implementations, a baseline vector observation equation formed based on attitude angle information constraints and baseline length may be established based on the following formula:
[0139] H c ·[r r3,b -r r1,b N r3,r1 ] T =XYZ r3,r1 +ε c , (6)
[0140] Among them, r1 and r3 are two receivers connected to different antennas, b is the reference station, H c =[I 3×3 0 n×n ], I is the identity matrix, r r3,b 、r r1,b are the position coordinates of the receivers r3 and r1 to be estimated relative to the reference station b, XYZ r3,r1 , ε c is the relative position of the receiver r3 to r1 obtained based on the attitude angle information of the carrier provided by the IMU, ε c is the measurement error of the relative position.
[0141] In the multi-receiver system according to this embodiment, the three baseline vectors formed by any three receivers (including the reference station) can form a closed triangle. In some embodiments, the baseline vector triangle closure error observation equation can be established based on the following formula:
[0142]
[0143] Among them, r1, r2, r3 are all receivers connected to the antenna and three receivers in the reference station, H d=[I -I -I], I is the identity matrix, are the position coordinates of receiver r1 relative to receiver r2, the position coordinates of receiver r3 relative to receiver r2, and the position coordinates of receiver r1 relative to receiver r3 in the RTK floating point solution, ε d is the RTK floating point solution estimation error.
[0144] by Figure 5 The above baseline vector triangle closure error observation equation (7) is exemplarily described by taking the triangle closed loop formed by receivers r1, r3 and reference station b according to an exemplary embodiment of the present disclosure as an example. Figure 5 The three baseline vectors 'r1-b', 'r3-b' and 'r1-r3' shown should satisfy the condition that the coordinate closure error is 0, that is:
[0145] r r1,b -r r3,b -r r1,r3 =0, (8)
[0146] This condition can be transformed to obtain the baseline vector triangle closure error observation equation as formula (7), which is used in the RTK solution process. Its specific form is as follows:
[0147]
[0148] Among them, H d =[I -I -I], I is the identity matrix, are the position coordinates of receivers r1 and r3 relative to base station b in the RTK floating point solution, is the position coordinate of receiver r1 relative to receiver r3 in the RTK floating point solution, ε d is the RTK floating point solution estimation error.
[0149] against Figure 3 In the dual-antenna four-receiver configuration shown, in addition to receivers R1, R3 and B, the triangular closed loop formed by other three receivers such as receivers R1, R2 and B, receivers R1, R2, R4, etc. can also construct the baseline vector triangle closure difference observation equation as shown in formula (7). Figure 1 The five receivers (receivers r1, r2, r3, r4 and base station b) can form a total of The baseline vector closure error is 0, as shown in formula (7). Extending to a configuration with L receivers, we can establish The baseline vector triangle closure difference observation equation is as shown in formula (7).
[0150] It should be noted that the above representations of the position coordinates and ambiguity of the baseline vector are all directional, such as r r1,r3 and Nr1,r3 denote the position coordinates and ambiguity of receiver r1 relative to r3, respectively. r3,r1 and N r3,r1 They represent the position coordinates and ambiguity of the receiver r3 relative to r1, and the conversion relationship between the two is r r1,r3 =-r r3,r1 , N r1,r3 =-N r3,r1 This directionality of the baseline vector applies to all formulas involved in this disclosure.
[0151] By combining the above formulas (3), (4), (6) and (7), an IMU-assisted multi-antenna multi-receiver RTK observation equation group can be constructed. The RTK observation equation group constructed in this embodiment combines a variety of constraints, significantly improving the positioning performance and reliability of the system. The traditional RTK observation equation (reference (3)) provides basic positioning information, while the pre-measured inter-antenna distance constraint (reference formula (4)) further enhances the geometric strength of the system. In particular, the baseline vector observation equation based on the IMU attitude angle information constraint (reference formula (6)) plays a key role in the equation group. This equation not only provides a high-precision estimate of the relative position between antennas, but also maintains positioning accuracy when the GNSS signal is severely blocked or interfered, thereby effectively making up for the shortcomings of the traditional RTK method in harsh environments and improving the system's anti-interference ability and positioning continuity. In addition, the closed loop constraint based on the multi-receiver composition (reference formula (7)) further increases the redundancy of the solution, which helps to detect and eliminate potential observation anomalies.
[0152] The diversified combination of RTK observation equations constructed according to this embodiment not only improves the positioning accuracy, but also significantly enhances the robustness and reliability of the system in complex urban environments, providing a more stable and reliable solution for high-precision navigation applications.
[0153] Step 4: Solve the IMU-assisted multi-antenna multi-receiver RTK observation equations to obtain an RTK fixed solution.
[0154] The process of estimating the RTK floating point solution and then calculating the RTK fixed solution has been introduced above, so it will not be repeated here. At the same time, the baseline length observation equation and the baseline vector triangle closure error observation equation play an important auxiliary role in the solution process, which helps to improve the accuracy and reliability of the solution. The baseline vector observation equation based on the attitude angle information constraint further utilizes the high-precision attitude information provided by the IMU to provide additional constraint equations for the relative position between antennas, which not only improves the positioning accuracy in complex observation environments, but also enhances the ability to resist GNSS signal obstruction and multipath effects. Especially when satellite visibility is limited, this constraint can effectively supplement the traditional RTK observation equation, improve the stability and reliability of the positioning solution, and further improve the positioning robustness.
[0155] Step 5: Use the geometric relationship between receivers to verify the RTK fixed solution through coordinate closure constraints and ambiguity closure constraints.
[0156] In some embodiments, validating the RTK fixed solution using coordinate closure constraints includes:
[0157] The RTK fixed solution is verified based on the following coordinate closure constraints:
[0158]
[0159] Among them, r1 and r3 are two receivers connected to the antenna, b is the reference station, is the position coordinate of the receiver r1 relative to the base station in the RTK fixed solution, is the position coordinate of the receiver r3 relative to the base station in the RTK fixed solution, is the position coordinate of receiver r1 relative to receiver r3 in the RTK fixed solution, ε f is the RTK fixed solution estimation error.
[0160] Ideally, the three baseline vectors should form a completely closed triangle, i.e. However, due to measurement errors and calculation errors in actual engineering, there may also be certain systematic errors between non-zero baseline receivers, so a small error ε can be allowed f If the coordinate closure error ε in formula (10) f Within the allowable error range, that is, the RTK fixed solution estimation error ε f If the absolute value of is less than the preset coordinate closure error threshold, the position coordinates in the RTK fixed solution can be considered reliable.
[0161] The selection of the coordinate closure error threshold can comprehensively consider a variety of factors, such as the expected accuracy of the RTK fixed solution, the complexity of the test environment, the performance of the receiver and antenna, the baseline length, etc. When selecting the coordinate closure error threshold, a balance can be achieved between the detection capability and the false alarm rate. If the coordinate closure error threshold is set too small, many valid fixed solutions may be mistakenly denied, while if it is set too large, the wrong fixed solution may not be effectively identified. In practical applications, those skilled in the art can determine the coordinate closure error threshold based on experiments and experience to adapt to specific application scenarios and requirements.
[0162] In some embodiments, validating the RTK fixed solution using ambiguity closure constraints includes:
[0163] The RTK fixed solution is verified based on the following ambiguity closure constraints:
[0164]
[0165] Among them, r1 and r3 are two receivers connected to the antenna, b is the reference station, They are the double difference ambiguity of receiver r1 and base station b to satellite j and satellite k in the RTK fixed solution, the double difference ambiguity of receiver r3 and base station b to satellite j and satellite k, and the double difference ambiguity of receiver r1 and receiver r3 to satellite j and satellite k.
[0166] Since the ambiguity is an integer value, the formula (11) should be accurate in the verification. If the formula (11) is not true, it means that there may be an error in the ambiguity fixation.
[0167] The ambiguity closure error constraint condition of formula (11) can also be used to check abnormal observations. Once the observation of a certain satellite does not meet the above ambiguity closure error constraint condition of 0, it can be considered that the observation is abnormal. The abnormal observation can be eliminated to update the available observation set, and RTK positioning can be re-performed based on the updated available observation set.
[0168] By applying coordinate closure constraints and ambiguity closure constraints, the correctness of the RTK fixed solution can be fully verified and abnormal observations can be eliminated. This multiple verification mechanism greatly improves the reliability of the RTK fixed solution, especially in complex urban environments.
[0169] In addition, for single-antenna dual-receiver RTK positioning, a necessary prerequisite for effective fixed solution verification based on the closure error constraints of formula (10) and formula (11) is that there is an observation difference when the two zero-baseline receivers process the signal of the same antenna. Because, if there is no observation difference between the two zero-baseline receivers, the closure error constraints of formulas (10) and (11) are always valid, and the detection meaning is lost. However, for the multi-antenna multi-receiver configuration proposed in this embodiment, due to the different antenna positions, the observation difference is more obvious. Therefore, the multi-antenna solution according to this embodiment can also make up for the problem of insufficient difference in the zero baseline observation of a single antenna.
[0170] Step 6: Use the short-term continuity of the position obtained by the IMU to verify the RTK fixed solution.
[0171] In some implementations, the short-term position continuity of the IMU can be used to detect outliers of RTK positioning using a coordinate sliding window, which may specifically include:
[0172] Set a sliding time window;
[0173] Taking the position coordinates of the RTK fixed solution at the starting point of the current time window as the reference point, starting from the reference point, the relative position change at each moment in the current time window is obtained based on the IMU integration;
[0174] Based on the reference point and the relative position change, the position of each moment predicted by the IMU in the current time window is obtained;
[0175] Compare the position predicted by the IMU at each moment in the current time window with the position coordinates of the RTK fixed solution at the corresponding moment to detect outliers in the RTK fixed solution.
[0176] When new data is received, the time window is slid forward.
[0177] In a specific implementation, a threshold may be set. In some examples, when the difference between the position predicted by the IMU at a certain moment and the RTK position coordinate exceeds the threshold, the RTK fixed solution at that moment may be marked as an outlier.
[0178] As mentioned above, when verifying the fixed solution of single-antenna dual-receiver RTK, a necessary condition for satisfying formulas (10) and (11) is that there is an obvious difference in the observed value when the two zero-baseline receivers r1 and r2 process the signal of the same antenna. Once there is no difference in the observed value, formulas (10) and (11) are always valid and lose the meaning of detection. In order to improve the problem of insufficient difference in the observed value of the zero-baseline receiver, the present disclosure provides a plurality of antennas (such as Figure 3a1 and a2 in the figure), using the position difference of the two antennas to improve the receiver observation difference; secondly, using the continuity of the IMU short-term position, the coordinate sliding window method is used to detect the wild value of the RTK positioning of multiple antennas and multiple receivers. Considering that the situation that causes formulas (10) and (11) to lose the meaning of detection occurs when two receivers with zero baseline (such as Figure 3 In the example, the positioning results of r1 and r2 connected by a1 are both wrong at the same time, and the wrong results still meet the detection conditions of formulas (10) and (11). The probability of this situation is low. Usually, RTK positioning wild values will appear when the detection error occurs. The short-term position continuity of IMU can effectively detect such wild values.
[0179] Step 7: Based on the inspection result, output the user terminal location information.
[0180] IMU can output the carrier's attitude angle information and acceleration information. Through acceleration integration and attitude angle coordinate conversion, the carrier's speed, position and attitude angle can be obtained. When the integration time is short, the speed, position and attitude angle can usually be maintained for a period of time.
[0181] In some embodiments, if the RTK fixed solution passes the test, the RTK fixed solution is output as the user-side positioning information; if the RTK fixed solution is tested as a wild value, the position obtained by the IMU is output as the user-side positioning information. In other words, when RTK positioning fails, the position provided by the IMU can be used to achieve RTK-free positioning output in a short period of time, and when RTK recovery is detected, the RTK positioning information is output again, thereby effectively solving the problem of GNSS positioning failure caused by short-term obstruction of the carrier passing through viaducts, traffic signs, etc.
[0182] The positioning solution of integrating multi-antenna multi-receiver RTK and inertial navigation proposed in this embodiment, on the one hand, adopts multi-antenna multi-receiver, greatly increases the number of observations, and introduces more baseline length constraints and baseline vector triangle closure constraints, effectively enhancing the geometric strength of the positioning solution, and effectively detecting abnormal observations through zero baseline configuration; on the other hand, by integrating the inertial measurement unit (IMU), the accuracy and reliability of positioning are further improved. The attitude angle information provided by the IMU not only provides additional constraints for the baseline vector between antennas, but also maintains high-precision position information in a short time. This feature is particularly important when the GNSS signal is severely blocked or interfered, and can effectively make up for the shortcomings of satellite navigation. In addition, the short-term continuity of IMU data can also be used to detect wild values in RTK positioning, further improving the robustness of positioning, and improving the problem of insufficient observation differences of zero baseline receivers.
[0183] Through the deep integration of multi-antenna multi-receiver, zero baseline configuration and IMU, this embodiment not only improves the problem of insufficient available observations in complex observation environments, but also maintains continuous high-precision positioning output when satellite signals are temporarily lost. This innovative combined positioning method significantly improves positioning performance in complex environments such as cities, especially boulevards, and provides more reliable and stable technical support for high-precision positioning applications such as autonomous driving and precision measurement.
[0184] In addition, according to some implementations of this embodiment, the zero-baseline double-difference observation can be used to effectively detect abnormal observations. Before constructing the IMU-assisted multi-antenna multi-receiver RTK observation equation group, the above-mentioned satellite navigation and inertial navigation combined positioning method can also include using the zero-baseline double-difference observation to detect abnormal observations through the following steps:
[0185] The zero baseline double difference pseudorange observation ZDO is calculated based on the following formula P and zero baseline double difference carrier phase observation ZDO φ :
[0186]
[0187] Among them, r1 and r2 are two receivers connected to the same antenna, is the double difference of pseudorange observations of satellites j and k from receivers r1 and r2, is the noise of the pseudorange double-difference observations, is the double difference observation of the carrier phase of satellites j and k by receivers r1 and r2, is the double-difference ambiguity of the carrier phase of receivers r1 and r2 to satellites j and k, is the noise of the carrier phase double difference observation;
[0188] If the calculated zero baseline double difference pseudorange observation ZDO P If the absolute value of exceeds the zero baseline pseudorange deviation threshold, the zero baseline double difference pseudorange observation ZDO is judged to be P There are anomalies in the related observations;
[0189] If the calculated zero baseline double-difference carrier phase observation ZDO φ If there is a full cycle jump, a half cycle jump, or exceeds the zero baseline carrier phase deviation threshold, the zero baseline double difference carrier phase observation ZDO is determined. φ There are anomalies in the related observations.
[0190] ZDO P and ZDO φThey represent the zero-baseline double-difference observation of pseudorange and the zero-baseline double-difference observation of carrier phase respectively. In the zero-baseline configuration, since the two receivers are connected to the same antenna, their physical positions can be considered the same. In theory, the double-difference observation ZDO calculated by formula (12) is P and ZDO φ should be very close to zero, containing only observation noise and possible hardware delays. Therefore, if the double-difference observation ZDO or ZDO φ Any value that deviates significantly from zero may indicate the presence of abnormal observations.
[0191] In some preferred embodiments, the zero-baseline pseudorange deviation threshold is 0.6 m, and / or the zero-baseline carrier phase deviation threshold is 10% of the carrier phase wavelength.
[0192] The inventors have conducted in-depth research on the zero baseline pseudorange observation noise and believe that it usually does not exceed 0.3m. When performing double difference operations, according to the error propagation law, the noise amplification factor of the double difference is 2.0. Therefore, in the preferred embodiment, the inventors set the zero baseline pseudorange deviation threshold to 0.6m (i.e. 0.3m×2), so as to effectively detect abnormal zero baseline double difference pseudorange observations ZDO with deviations exceeding ±0.6m. P .
[0193] In one example, if the calculated ZDO P If the absolute value of exceeds 0.6m, it is possible that one or more of the observations of receiver r1 using satellite j, the observations of receiver r1 on reference satellite k, the observations of receiver r2 using satellite j, and the observations of receiver r2 on reference satellite k are abnormal. That is, the abnormality may come from a single observation value or from a combination of multiple observations.
[0194] When dealing with abnormal observations, the abnormal zero baseline double difference pseudorange observation ZDO can be used. P All related observations are marked as abnormal observations. In the subsequent processing, these observations are eliminated or their weights are reduced. They can also be analyzed in combination with time series and other double-difference data to further determine or narrow the scope of abnormal observations and then process them.
[0195] The inventors set the zero-baseline carrier phase deviation threshold to 10% of the carrier phase wavelength in the preferred embodiment based on the following considerations. Considering that the observation noise of the carrier phase is usually 0.003m, and the wavelength of the carrier phase is about 0.2m, this means that the zero-baseline carrier phase observation noise is usually less than 1.5% of the carrier phase wavelength (0.003m / 0.2m=1.5%). In order to strike a balance between detecting anomalies and retaining valid data, and appropriately relax the threshold to obtain more observations, the inventors preferably set the zero-baseline carrier phase deviation threshold to 10% of the carrier phase wavelength, which can effectively detect non-integer deviations while avoiding misjudging normal observation noise as abnormal.
[0196] As mentioned above, in an ideal situation with no transition or deviation, ZDO φ should be very close to an integer. Therefore, if we observe that the calculated ZDO φ A sudden change of nearly an integer number of wavelengths indicates that a full cycle jump may have occurred; if the calculated ZDO is observed φ A sudden change of nearly half a wavelength indicates that a half-cycle jump may have occurred; if the calculated ZDO φ If the carrier phase deviation exceeds 10% of the wavelength, a non-integer deviation may have occurred.
[0197] In one example, when an abnormal zero baseline double-difference carrier phase observation ZDO is observed φ , then there may be anomalies in one or more of the carrier phase observations of receiver r1 using satellite j, the carrier phase observations of receiver r1 using reference satellite k, the carrier phase observations of receiver r2 using satellite j, and the carrier phase observations of receiver r2 using reference satellite k. For integer jumps and half-cycle jumps, the anomaly usually occurs in a single observation, and the abnormal observation can be determined by combining the time series; for non-integer deviations, it may be a problem caused by a single observation, or it may be the result of the combined effect of multiple observations.
[0198] Similarly, for the zero baseline double difference carrier phase observation ZDO φ The abnormal zero baseline double difference carrier phase observation ZDO can be processed φ All related observations are marked as abnormal observations. In the subsequent processing, these observations are eliminated or their weights are reduced. They can also be analyzed in combination with time series and other double-difference data to further determine or narrow the scope of abnormal observations and then process them.
[0199] Using zero-baseline double-difference observations, abnormal observations can be effectively identified and processed, improving the accuracy and reliability of subsequent RTK solutions. Especially in complex urban environments such as tree-lined roads, abnormal observation detection can greatly improve the performance of RTK positioning.
[0200] Furthermore, since this embodiment uses multiple antennas and multiple receivers, even if some observations are eliminated due to abnormalities, there are still enough other observations to support RTK solution.
[0201] In some embodiments, the IMU is a fiber optic inertial measurement unit; in other embodiments, the IMU is a microelectromechanical (MEMS) inertial measurement sensor.
[0202] Those skilled in the art can select IMU according to actual needs. For example, when the positioning accuracy requirement is very high or it is necessary to maintain the non-RTK positioning output for a long time, a high-precision fiber optic inertial measurement unit can be used, and the corresponding equipment cost is relatively high; in other cases, considering that the multi-antenna multi-receiver satellite positioning used in this embodiment can usually maintain a high RTK fixation success rate, the IMU can also choose a low-cost micro-electromechanical (MEMS) inertial measurement sensor.
[0203] In order to better understand the multi-antenna multi-receiver satellite positioning method proposed in the present disclosure, the following takes a dual-antenna four-receiver RTK positioning system as an example to describe its working process in detail. Figure 6 A schematic diagram of the dual-antenna four-receiver positioning process is shown.
[0204] First, the observation data is obtained through the single antenna dual receiver and dual antenna dual receiver parts, and the attitude and velocity information provided by the IMU is obtained. The single antenna dual receiver part calculates the zero baseline observation, and the abnormal observation is detected according to formula (12). This step can effectively detect abnormal carrier phase observations such as cycle slips, half-cycle and non-full cycle deviations, as well as abnormal pseudorange observations, thereby significantly improving the quality of the observation data.
[0205] Next, we enter the RTK floating-point solution estimation stage. In this stage, multiple key equations are combined. The single-antenna dual-receiver observation data after processing the abnormal observations is used to fix the zero baseline carrier phase ambiguity, and the single-antenna dual-receiver observation equation (reference formula (3)) and the baseline vector triangle closure error observation equation (reference formula (7)) are established. The dual-antenna dual-receiver RTK observation equation (reference formula (3)), the baseline vector triangle closure error observation equation (reference formula (7)), and the dual-antenna baseline length observation equation (reference formula (4)) are established using the dual-antenna dual-receiver observation data. According to the attitude and velocity information provided by the IMU, the dual-antenna baseline vector observation equation is established (reference formula (6)). With the help of these formulas, the RTK floating-point solution observation equation is solved, and the RTK floating-point solution is obtained by least squares estimation, including the estimated coordinate position and ambiguity floating-point solution, and the carrier phase integer ambiguity is fixed.
[0206] Finally, the RTK fixed solution estimation stage is entered. In this stage, the fixed solution is first checked using the constraint condition that the ambiguity closure error after fixation is 0, refer to formula (11), and then the fixed solution is checked using the constraint condition that the coordinate closure error of the fixed solution is 0, refer to formula (10), and the short-term position continuity of the IMU is used to use a sliding window to check the RTK fixed solution and the continuous extrapolation results of the IMU to eliminate abnormal RTK positioning results. When the RTK solution fails, the extrapolation results of the IMU are used to maintain the positioning result output for a short time.
[0207] The embodiment of the present disclosure also provides a multi-antenna multi-receiver satellite positioning system, which is arranged at a user end and includes multiple antennas, at least one power splitter, multiple receivers, an inertial measurement unit (IMU), a communication module, and a data processing module, wherein:
[0208] The antenna is used to receive satellite signals;
[0209] The receiver is connected to the antenna and is used to process the satellite signal to obtain an observed quantity, wherein at least one of the antennas is connected to at least two receivers via the corresponding power divider to form a zero baseline configuration;
[0210] The communication module is used to receive the observation value of the reference station;
[0211] The IMU is used to obtain the speed, position and attitude angle information of the user-side carrier based on the measurement data;
[0212] The data processing module is connected to the multiple receivers, the IMU and the communication module, and is used to execute the satellite navigation and inertial navigation combined positioning method as described above based on the observations of the receivers, the observations of the reference station and the speed, position and attitude angle information provided by the IMU.
[0213] For other details and advantages of the system, please refer to the above description of the combined positioning method of satellite navigation and inertial navigation, which will not be repeated here.
[0214] The present disclosure also provides a satellite navigation and inertial navigation combined positioning device, including:
[0215] An observation acquisition unit, used to acquire observations of multiple receivers of multiple antennas at the user end and observations of the reference station, wherein at least one of the antennas is connected to at least two of the receivers via a power divider to form a zero baseline configuration;
[0216] An IMU information acquisition unit is used to obtain the speed, position and attitude angle information of the user-side carrier provided by an inertial measurement unit (IMU);
[0217] An observation equation group construction unit is used to construct an IMU-assisted multi-antenna multi-receiver real-time differential positioning (RTK) observation equation group based on the observation quantities of the multiple receivers and the observation quantities of the reference station, the speed, the position and the attitude angle information of the carrier;
[0218] An RTK solving unit, used for solving the IMU-assisted multi-antenna multi-receiver RTK observation equation group to obtain an RTK fixed solution;
[0219] The triangle closure constraint verification unit is used to verify the RTK fixed solution by using the geometric relationship between receivers through coordinate closure constraints and ambiguity closure constraints;
[0220] IMU short-time continuity verification unit, used to verify the outliers in the RTK fixed solution using the short-time continuity of the position obtained by the IMU;
[0221] The positioning output unit is used to output the user terminal positioning information based on the inspection result.
[0222] For other details and advantages of the device, please refer to the above description of the combined positioning method of satellite navigation and inertial navigation, which will not be repeated here.
[0223] Figure 7 An electronic device provided for at least one embodiment of the present disclosure includes a memory and a processor, wherein the memory is used to store computer instructions that can be executed on the processor, and the processor is used to implement the satellite navigation and inertial navigation combined positioning method described in any embodiment or implementation method of the present disclosure when executing the computer instructions.
[0224] At least one embodiment of the present disclosure further provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the satellite navigation and inertial navigation combined positioning method described in any embodiment or implementation of the present disclosure.
[0225] It should be understood by those skilled in the art that one or more embodiments of the present specification may be provided as a method, system or computer program product. Therefore, one or more embodiments of the present specification may take the form of a complete hardware embodiment, a complete software embodiment or an embodiment combining software and hardware. Moreover, one or more embodiments of the present specification may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0226] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can be referred to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the data processing device embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and the relevant parts can be referred to the partial description of the method embodiment.
[0227] The above is a description of a specific embodiment of the specification. Other embodiments are within the scope of the appended claims. In some cases, the actions or steps recorded in the claims can be performed in an order different from that in the embodiments and still achieve the desired results. In addition, the processes depicted in the drawings do not necessarily require the specific order or continuous order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.
[0228] The embodiments of the subject matter and functional operations described in this specification may be implemented in the following: digital electronic circuits, tangibly embodied computer software or firmware, computer hardware including the structures disclosed in this specification and their structural equivalents, or a combination of one or more of them. The embodiments of the subject matter described in this specification may be implemented as one or more computer programs, i.e., one or more modules in computer program instructions encoded on a tangible non-temporary program carrier to be executed by a data processing device or to control the operation of the data processing device. Alternatively or additionally, the program instructions may be encoded on an artificially generated propagation signal, such as a machine-generated electrical, optical or electromagnetic signal, which is generated to encode information and transmit it to a suitable receiver device for execution by a data processing device. The computer storage medium may be a machine-readable storage device, a machine-readable storage substrate, a random or serial access memory device, or a combination of one or more of them.
[0229] The processes and logic flows described in this specification can be performed by one or more programmable computers executing one or more computer programs to perform corresponding functions by operating on input data and generating output. The processes and logic flows can also be performed by special purpose logic circuits, such as FPGAs (field programmable gate arrays) or ASICs (application-specific integrated circuits), and the apparatus can also be implemented as special purpose logic circuits.
[0230] Computers suitable for executing computer programs include, for example, general and / or special microprocessors, or any other type of central processing unit. Typically, the central processing unit will receive instructions and data from a read-only memory and / or a random access memory. The basic components of a computer include a central processing unit for implementing or executing instructions and one or more memory devices for storing instructions and data. Typically, the computer will also include one or more large-capacity storage devices for storing data, such as magnetic disks, magneto-optical disks, or optical disks, or the computer will be operably coupled to this large-capacity storage device to receive data from it or to transmit data to it, or both. However, the computer does not necessarily have such a device. In addition, the computer can be embedded in another device, such as a mobile phone, a personal digital assistant (PDA), a mobile audio or video player, a game console, a global positioning system (GPS) receiver, or a portable storage device such as a universal serial bus (USB) flash drive, to name a few.
[0231] Computer readable media suitable for storing computer program instructions and data include all forms of non-volatile memory, media and memory devices, including, for example, semiconductor memory devices (e.g., EPROM, EEPROM and flash memory devices), magnetic disks (e.g., internal hard disks or removable disks), magneto-optical disks, and CD ROM and DVD-ROM disks. The processor and memory may be supplemented by, or incorporated in, special purpose logic circuitry.
[0232] Although this specification includes many specific implementation details, these should not be interpreted as limiting the scope of any invention or the scope of protection claimed, but are mainly used to describe the features of the specific embodiments of specific inventions. Certain features described in multiple embodiments in this specification may also be implemented in combination in a single embodiment. On the other hand, the various features described in a single embodiment may also be implemented separately in multiple embodiments or in any suitable sub-combination. In addition, although features may work in certain combinations as described above and even initially claim protection, one or more features from the claimed combination may be removed from the combination in some cases, and the claimed combination may point to a sub-combination or a variation of a sub-combination.
[0233] Similarly, although operations are depicted in a particular order in the accompanying drawings, this should not be understood as requiring that these operations be performed in the particular order shown or performed sequentially, or requiring that all illustrated operations be performed to achieve the desired results. In some cases, multitasking and parallel processing may be advantageous. In addition, the separation of various system modules and components in the above-described embodiments should not be understood as requiring such separation in all embodiments, and it should be understood that the described program components and systems can generally be integrated together in a single software product, or packaged into multiple software products.
[0234] Thus, specific embodiments of the subject matter have been described. Other embodiments are within the scope of the appended claims. In some cases, the actions recited in the claims can be performed in a different order and still achieve the desired results. In addition, the processes depicted in the drawings do not necessarily require the particular order or sequential order shown to achieve the desired results. In some implementations, multitasking and parallel processing may be advantageous.
[0235] The above description is merely a preferred embodiment of one or more embodiments of the present specification and is not intended to limit one or more embodiments of the present specification. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of one or more embodiments of the present specification shall be included in the scope of protection of one or more embodiments of the present specification.
Claims
1. A satellite navigation and inertial navigation combined positioning method, It is characterized in that include: Obtaining observations of multiple receivers of multiple antennas at the user end and observations of the reference station, wherein at least one of the antennas is connected to at least two of the receivers via a power divider to form a zero baseline configuration; Obtain the speed, position and attitude angle information of the user-side carrier provided by the inertial measurement unit (IMU); Based on the observations of the multiple receivers and the observations of the reference station, the speed, the position and the attitude angle information provided by the IMU, construct an IMU-assisted multi-antenna multi-receiver real-time differential positioning (RTK) observation equation group; Solving the IMU-assisted multi-antenna multi-receiver RTK observation equations to obtain an RTK fixed solution; Using the geometric relationship between receivers, the RTK fixed solution is verified through coordinate closure constraints and ambiguity closure constraints; Use the short-term continuity of the position obtained by the IMU to detect outliers in the RTK fixed solution; Based on the inspection results, the user terminal positioning information is output.
2. The method according to claim 1, It is characterized in that The IMU-assisted multi-antenna multi-receiver RTK observation equations include: Establishing an RTK observation equation of a baseline formed by the receiver of the user end and the reference station; Establishing the baseline length observation equation based on the pre-measured inter-antenna distance constraint; Establishing a baseline vector observation equation formed based on the attitude angle information and the baseline length; The baseline vector triangle closure error observation equation based on the closed loop constraint of multiple receivers is established.
3. The method according to claim 2, It is characterized in that Establishing an RTK observation equation of a baseline formed by the receiver of the user terminal and the reference station, comprising: The RTK observation equation of the baseline formed by the receiver of the user end and the reference station is established based on the following formula: H a ·x=l a +e, Among them, H a is the linearization matrix, l a is the linearized observation residual matrix, x is the result to be estimated, x includes the position coordinates of the receiver connected to the antenna relative to the reference station and the corresponding double difference ambiguity, and ε is the observation noise.
4. The method according to claim 2, It is characterized in that The baseline length observation equation is established based on the pre-measured inter-antenna distance constraint, including: The baseline length observation equation is established based on the following formula: H e ·[r r3,b -r r1,b N r3,r1 ] T =d r3,r1 +ε e , Among them, r1 and r3 are two receivers connected to different antennas, b is the reference station, are the position coordinates of receivers r1 and r3 relative to the base station b in the RTK floating point solution, n is the number of double difference observations, and r r1,b 、r r3,b are the position coordinates of the receivers r1 and r3 to be estimated relative to the reference station b, N r3,r1 is the integer ambiguity of receiver r1 relative to receiver r3, d r3,r1 is the pre-measured distance between the two antennas connecting the receivers r1 and r3, ε e is the measurement error of the distance between the two antennas.
5. The method according to claim 2, It is characterized in that Establishing a baseline vector observation equation based on the attitude angle information and the baseline length, including: The baseline vector observation equation is established based on the following formula: H c ·[r r3,b -r r1,b N r3,r1 ] T =XYZ r3,r1 +ε c , Among them, r1 and r3 are two receivers connected to different antennas, b is the reference station, H c =[I 3×3 0 n×n ], I is the identity matrix, r r3,b 、r r1,b are the position coordinates of the receivers r3 and r1 to be estimated relative to the reference station b, XYZ r3,r1 is the relative position of the receiver r3 to r1 obtained based on the attitude angle information provided by the IMU, ε c is the measurement error of the relative position.
6. The method according to claim 5, It is characterized in that The method further comprises: The baseline vector NEU from receiver r3 to r1 in the North East Sky Coordinate System (NEU) is obtained based on the following formula: r3,r1 : NEW r3,r1 =d r3,r1 *[cos(y)cos(p) sin(y)cos(p) sin(p)] T , Among them, d r3,r1 is the pre-measured distance between the two antennas connecting the receivers r1 and r3, y is the azimuth angle in the attitude angle information, and p is the pitch angle in the attitude angle information; By the latitude and longitude of the carrier coordinates, NEU r3,r1 Convert to the XYZ coordinate system used by satellite positioning to obtain the position coordinates XYZ of the receiver r3 to r1 in the XYZ coordinate system r3,r1 .
7. The method according to claim 2, It is characterized in that The baseline vector triangle closure error observation equation based on the closed loop constraint of multiple receivers is established: The baseline vector triangle closure error observation equation is established based on the following formula: Among them, r1, r2, r3 are all receivers connected to the antenna and three receivers in the reference station, H d =[II -I], I is the identity matrix, are the position coordinates of receiver r1 relative to receiver r2, the position coordinates of receiver r3 relative to receiver r2, and the position coordinates of receiver r1 relative to receiver r3 in the RTK floating point solution, ε d is the RTK floating point solution estimation error.
8. The method according to claim 1, Features: Verification of the RTK fixed solution through coordinate closure constraints includes: The RTK fixed solution is verified based on the following coordinate closure constraints: Among them, r1 and r3 are two receivers connected to the antenna, b is the reference station, is the position coordinate of the receiver r1 relative to the base station in the RTK fixed solution, is the position coordinate of the receiver r3 relative to the base station in the RTK fixed solution, is the position coordinate of receiver r1 relative to receiver r3 in the RTK fixed solution, ε f is the estimated error of the preset RTK fixed solution; Verification of the RTK fixed solution through ambiguity closure constraints includes: The ambiguity terms corresponding to the RTK fixed solution are verified based on the following ambiguity closure constraints: Among them, r1 and r3 are two receivers connected to the antenna, b is the reference station, They are the double difference ambiguity of receiver r1 and base station b to satellite j and satellite k in the RTK fixed solution, the double difference ambiguity of receiver r3 and base station b to satellite j and satellite k, and the double difference ambiguity of receiver r1 and receiver r3 to satellite j and satellite k.
9. The method according to claim 1, It is characterized in that Use the short-term continuity of the position obtained by the IMU to check for outliers in the RTK fixed solution, including: Set a sliding time window; Taking the position coordinates of the RTK fixed solution at the starting point of the current time window as the reference point, starting from the reference point, the relative position change at each moment in the current time window is obtained based on the IMU integration; Based on the reference point and the relative position change, the position predicted by the IMU at each moment in the current time window is obtained; Compare the position predicted by the IMU at each moment in the current time window with the position coordinates of the RTK fixed solution at the corresponding moment to detect outliers in the RTK fixed solution.
10. The method according to claim 1, It is characterized in that Before constructing the IMU-assisted multi-antenna multi-receiver RTK observation equation group, the method further includes detecting abnormal observations using zero-baseline double-difference observations through the following steps: The zero baseline double difference pseudorange observation ZDO is calculated based on the following formula P and zero baseline double difference carrier phase observation ZDO φ : Among them, r1 and r2 are two receivers connected to the same antenna, is the double difference of pseudorange observations of satellites j and k from receivers r1 and r2, is the noise of the pseudorange double-difference observations, is the double difference observation of the carrier phase of satellites j and k by receivers r1 and r2, is the double-difference ambiguity of the carrier phase of receivers r1 and r2 to satellites j and k, is the noise of the carrier phase double difference observation; If the calculated zero baseline double difference pseudorange observation ZDO P If the absolute value of exceeds the zero baseline pseudorange deviation threshold, the zero baseline double difference pseudorange observation ZDO is judged to be P There are anomalies in the related observations; If the calculated zero baseline double-difference carrier phase observation ZDO φ If there is a full cycle jump, a half cycle jump, or exceeds the zero baseline carrier phase deviation threshold, the zero baseline double difference carrier phase observation ZDO is determined. φ There are anomalies in the related observations.
11. The method according to claim 10, It is characterized in that The zero baseline pseudorange deviation threshold is 0.6 m, and / or the zero baseline carrier phase deviation threshold is 10% of the carrier phase wavelength.
12. The method according to claim 1, It is characterized in that Based on the inspection results, the output user terminal positioning information includes: If the RTK fixed solution passes the verification, outputting the RTK fixed solution as the user terminal positioning information; If the RTK fixed solution is verified to be an outlier, the position obtained by the IMU is output as the user-side positioning information.
13. The method according to claim 1, It is characterized in that The IMU is a fiber optic inertial measurement unit or a micro-electromechanical system (MEMS) inertial measurement sensor.
14. A satellite navigation and inertial navigation combined positioning system, It is characterized in that The system is arranged at the user end, and includes multiple antennas, at least one power divider, multiple receivers, an inertial measurement unit (IMU), a communication module and a data processing module, wherein: The antenna is used to receive satellite signals; The receiver is connected to the antenna and is used to process the satellite signal to obtain an observed quantity, wherein at least one of the antennas is connected to at least two receivers via the corresponding power divider to form a zero baseline configuration; The communication module is used to receive the observation value of the reference station; The IMU is used to obtain the speed, position and attitude angle information of the user-side carrier based on the measurement data; The data processing module is connected to the multiple receivers, the IMU and the communication module, and is used to execute the method described in any one of claims 1 to 13 based on the observations of the receivers, the observations of the reference station and the speed, position and attitude angle information provided by the IMU.
15. A satellite navigation and inertial navigation combined positioning device, It is characterized in that include: An observation acquisition unit, used to acquire observations of multiple receivers of multiple antennas at the user end and observations of the reference station, wherein at least one of the antennas is connected to at least two of the receivers via a power divider to form a zero baseline configuration; An IMU information acquisition unit is used to obtain the speed, position and attitude angle information of the user-side carrier provided by an inertial measurement unit (IMU); An observation equation group construction unit is used to construct an IMU-assisted multi-antenna multi-receiver real-time differential positioning (RTK) observation equation group based on the observation quantities of the multiple receivers and the observation quantities of the reference station, the speed, the position and the attitude angle information of the carrier; An RTK solving unit, used for solving the IMU-assisted multi-antenna multi-receiver RTK observation equation group to obtain an RTK fixed solution; The triangle closure constraint verification unit is used to verify the RTK fixed solution by using the geometric relationship between receivers through coordinate closure constraints and ambiguity closure constraints; IMU short-time continuity verification unit, used to verify the outliers in the RTK fixed solution using the short-time continuity of the position obtained by the IMU; The positioning output unit is used to output the user terminal positioning information based on the inspection result.
16. An electronic device, It is characterized in that The device comprises a memory and a processor, wherein the memory is used to store computer instructions executable on the processor, and the processor is used to implement the method according to any one of claims 1 to 13 when executing the computer instructions.
17. A computer-readable storage medium having a computer program stored thereon, It is characterized in that When the program is executed by a processor, the method according to any one of claims 1 to 13 is implemented.
