GNSS trajectory constraint absolute measurement correction method

Through the similar adjustment processing of inertia/odometer dead estimation and differential satellite receiver positioning results, combined with the Kalman filtering model, the problem that the existing technology is difficult to meet the high-speed measurement needs, and the high-quality based on differential satellite receivers is achieved Absolute accuracy measurement, significantly improving measurement efficiency and accuracy.

CN119001780APending Publication Date: 2024-11-22BEIJING AUTOMATION CONTROL EQUIP INST
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411233336.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-04
Publication Date
2024-11-22

AI Technical Summary

Technical Problem

The existing absolute measurement methods are difficult to meet the high-speed measurement needs, especially in high-speed railway applications. The maximum error of real-time differential measurement of differential satellite navigation systems is 2cm, which cannot meet the orbital smoothness measurement requirements of mm-level.

Method used

The trajectory sequence is obtained through inertia/odometer dead estimation, and the positioning results of the differential satellite receiver are similarly adjusted to obtain the angle change rate to correct the combined navigation trajectory of inertia/odometer, and the combined navigation state space model is used for Kalman filtering. Perform error estimation to achieve high-precision absolute measurement based on differential satellite receivers.

Benefits of technology

The operation efficiency of geometric parameter measurement is significantly improved, and the combined inertia/odometer trajectory after correcting the system error falls within the error zone of the satellite measurement result, retaining the orbital smoothness characteristics, and achieving high-precision absolute measurement.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119001780A_ABST
    Figure CN119001780A_ABST
Patent Text Reader

Abstract

The invention provides a GNSS (Global Navigation Satellite System) trajectory constraint absolute measurement correction method. The correction method comprises the following steps: step 1, acquiring a trajectory sequence POD through dead reckoning of an inertia / odometer; step 2, performing similarity adjustment processing on the positioning result of the differential satellite receiver to obtain a satellite track sequence which is defined as PG and UTC time corresponding to each point; step 3, searching the position of the corresponding time in the POD according to the UTC time, and forming a new sequence PD = {PD1, PD2,... P1}, {PD1, PD2,... P1} belongs to {POD1, POD2,... PODm}; pDi represents a positioning point screened from the search POD; 4, acquiring an angle change rate sigma i according to the satellite track sequence and a new sequence PD table; and 5, correcting the inertia / odometer combined navigation track according to the angle change rate. According to the method, the parking alignment process of the total station is omitted, and the working efficiency of geometric parameter measurement is remarkably improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of inertial navigation, and relates to a GNSS trajectory constraint absolute measurement correction method, in particular to an absolute measurement trajectory correction method for an orbit geometry parameter detection system. Background Art

[0002] In the measurement of track geometry parameters, absolute measurement refers to the measurement performed with an external reference benchmark, which is used to obtain the absolute coordinates of each measurement point on the track in the measurement coordinate system. This measurement method can not only detect various smoothness parameters of the track, but also determine the absolute position of the line mileage and the center of the track. Absolute measurement usually relies on high-precision control points and measuring equipment, such as CPIII control points and total stations. The CPIII control points provide high-precision absolute benchmarks, and the total station measures the high-precision relative position of the track inspection system relative to the CPIII control points, and the measurement accuracy can reach the mm level. High-precision absolute measurement can ensure that the deviation between the geometric parameters of the track and the design target is kept to a minimum, which is particularly important for applications such as high-speed railways that have extremely high requirements for track smoothness. However, the total station has a slow measurement speed, a large interval between CPIII control points, and a high maintenance cost. The existing absolute measurement method is difficult to meet the needs of high-speed measurement. The differential satellite navigation system can provide continuous high-precision positioning results, but its maximum error in real-time differential measurement is 2cm. The trajectory noise obtained by the conventional inertial / satellite combination method is large, and the track smoothness characteristics are submerged in the positioning error, which is difficult to meet the mm-level measurement requirements. Summary of the invention

[0003] The present invention aims to solve at least one of the technical problems existing in the prior art or related art.

[0004] To this end, the present invention provides a GNSS trajectory constraint absolute measurement correction method.

[0005] The technical solution of the present invention is as follows:

[0006] According to one aspect, a GNSS trajectory constraint absolute measurement correction method is provided, the correction method comprising:

[0007] Step 1: Obtain trajectory sequence through inertial / odometer dead reckoning, defined as P OD = {P OD1 ,P OD2 ,...P ODm}, where P OD i represents the positioning point of the inertial / odometer combination;

[0008] Step 2: Perform similarity adjustment on the differential satellite receiver positioning results to obtain a satellite trajectory sequence defined as P G = {PG1 ,P G2 ,...P Gl}, and the UTC time corresponding to each point; where P Gi Indicates the position obtained through similarity adjustment;

[0009] Step 3: Search for P according to the UTC time OD The corresponding time position in the sequence P D = {P D1 ,P D2 ,...P l},{P D1 ,P D2 ,...P l}∈{P OD1 ,P OD2 ,...P ODm};P Di Indicates that from the search P OD The selected positioning points;

[0010] Step 4: Based on the satellite trajectory sequence and the new sequence P D Table to obtain the angle change rate σ i ;

[0011] Step 5: Correct the inertial / odometer combined navigation trajectory according to the angle change rate.

[0012] Furthermore, the step 4 specifically includes:

[0013] Calculate the slope of the straight line and And then recursively calculate the angle change rate σ between the two sets of straight lines i , as shown below:

[0014]

[0015] Furthermore, the step five specifically includes:

[0016] 1) Set σ i According to the time period, correct the gyro output of the inertial navigation system;

[0017] 2) Based on step 1), re-perform inertial / odometer combined navigation according to the method of step 1;

[0018] 3) Based on step 2), perform steps 3 to 4, and then go to step 1) until the obtained σ i If the value is less than the set correction judgment threshold ξ, the inertial / odometer combined trajectory falls within the error band of the satellite measurement result, and the trajectory correction ends.

[0019] Furthermore, the step 1 specifically includes:

[0020] 1) Establishing an inertial / odometer Kalman filter combined navigation state space model, wherein the space model includes a state equation and a measurement equation;

[0021] 2) Use the gyroscope and accelerometer of the inertial navigation system to perform inertial navigation solution, and estimate the error state through Kalman filtering in combination with the model in step 1).

[0022] Furthermore, the state equation is constructed by the following formula:

[0023] X k =Φ k,k-1 X k-1 +w k-1

[0024] In the formula,

[0025] State variables Where the misalignment angle φ=[φ E φ N φ U ] Τ , speed error δv n =[δV E δV N δV U ] T , Inertial navigation position error Including latitude error Longitude error δλ, altitude error δh, dead reckoning position error Including latitude error Longitude error δλ D , height error δh D , carrier system gyro drift ε b =[ε x ε y ε z ] T , load system accelerometer zero bias and the odometer error κ D =[α θ δK D α ψ ] T , including the pitch angle α between the inertial navigation carrier coordinate system and the odometer coordinate system θ , heading angle α ψ and odometer scale factor error δK D .

[0026] X k and X k-1 are the state vectors estimated at time k and time k-1 respectively;

[0027] Φ k,k-1 is the state transfer matrix of the state equation;

[0028] w k -1 is the system error.

[0029] Furthermore, the measurement equation is constructed by the following formula:

[0030] Z k =H k X k +V k

[0031] Among them, Z k is the measurement vector at time k; H k is the measurement matrix at time k, V k is the random noise vector measured at time k.

[0032] Furthermore, the step 2 specifically includes:

[0033] 2.1 Given a sequence P consisting of a series of differential satellite positioning results GPS = {P1,P2,...P n}, and an error tolerance ε,P i is the position of the i-th measurement;

[0034] 2.2 P1 and P n Mark as a reserved point;

[0035] 2.3 Calculation of P GPS All points to line segments The vertical distance d of the offline segment The farthest point P i ;

[0036] 2.4 If point P i The corresponding vertical distance d≤ε, then P1 and P are retained. n , delete P1 and P n All other points between two points; if d>ε, then P i To retain the point, recursively of Repeat steps 2.1 to 2.4;

[0037] 2.5 When the errors of all sub-segments are less than or equal to ε, the calculation of satellite similarity trajectories is completed and the satellite trajectory sequence is obtained.

[0038] According to another aspect, a computer device is provided, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above method when executing the computer program.

[0039] The above technical solution converts the position errors of satellite and inertial measurements into equivalent system errors of inertial measurement devices by performing similarity adjustment processing on the positioning results of differential satellite receivers, so that the inertial / odometer combined trajectory after correcting the system error falls within the error band of the satellite measurement results while retaining the orbit smoothness characteristics, thereby achieving high-precision absolute measurement based on the trajectory constraints of differential satellite receivers.

[0040] In summary, the present invention uses the differential satellite receiver positioning results to replace the traditional CPIII control point + total station optical measurement method, so that the inertial / odometer combined trajectory after correcting the system error falls within the error band of the satellite measurement result, while retaining the track smoothness characteristics, thereby achieving high-precision absolute measurement based on the differential satellite receiver trajectory constraints. The process of parking and aligning the total station is eliminated, which significantly improves the efficiency of geometric parameter measurement operations. BRIEF DESCRIPTION OF THE DRAWINGS

[0041] The included drawings are used to provide a further understanding of the embodiments of the present invention, which constitute a part of the specification, are used to illustrate the embodiments of the present invention, and together with the text description, explain the principles of the present invention. Obviously, the drawings in the following description are only some embodiments of the present invention, and for ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0042] Figure 1 This is the Kalman filter flow chart. DETAILED DESCRIPTION

[0043] It should be noted that, in the absence of conflict, the embodiments in this application and the features in the embodiments can be combined with each other. The technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. The following description of at least one exemplary embodiment is actually only illustrative and is by no means intended to limit the present invention and its application or use. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0044] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present application. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprise" and / or "include" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.

[0045] Unless otherwise specifically stated, the relative arrangement of the parts and steps described in these embodiments, numerical expressions and numerical values ​​do not limit the scope of the present invention. At the same time, it should be understood that, for ease of description, the sizes of the various parts shown in the accompanying drawings are not drawn according to the actual proportional relationship. The technology, method and equipment known to ordinary technicians in the relevant field may not be discussed in detail, but in appropriate cases, the technology, method and equipment should be regarded as a part of the authorization specification. In all examples shown and discussed here, any specific value should be interpreted as being merely exemplary, rather than as a limitation. Therefore, other examples of exemplary embodiments may have different values. It should be noted that similar reference numerals and letters represent similar items in the following drawings, so once a certain item is defined in an accompanying drawing, it does not need to be further discussed in subsequent drawings.

[0046] In one embodiment of the present invention, a GNSS trajectory constraint absolute measurement correction method is provided, the correction method comprising:

[0047] Step 1: Obtain trajectory sequence through inertial / odometer dead reckoning, defined as P OD = {P OD1 ,P OD2 ,...P ODm}, where P OD i represents the positioning point of the inertial / odometer combination;

[0048] Step 2: Perform similarity adjustment on the differential satellite receiver positioning results to obtain a satellite trajectory sequence defined as P G = {P G1 ,P G2 ,...P Gl} (the embodiment of the present invention considers that the general measurement condition is a uniform speed, in which the elements are arranged according to time), and the UTC time corresponding to each point; wherein, P Gi Indicates the position obtained through similarity adjustment;

[0049] Step 3: Search for P according to the UTC time OD The corresponding time position in the sequence P D = {P D1 ,P D2 ,...P l},{P D1 ,P D2 ,…P l}∈{P OD1 ,P OD2 ,...P ODm};P Di Indicates that from the search POD The positioning points selected in the embodiment of the present invention consider that the general measurement condition is uniform speed promotion, P D The elements can be arranged in time;

[0050] Step 4: Based on the satellite trajectory sequence and the new sequence P D Table to obtain the angle change rate σ i ;

[0051] Step 5: Correct the inertial / odometer combined navigation trajectory according to the angle change rate.

[0052] It can be seen that the embodiment of the present invention converts the position errors of satellite and inertial measurements into equivalent system errors of the inertial measurement device by performing similarity adjustment processing on the positioning results of the differential satellite receiver, so that the inertial / odometer combined trajectory after correcting the system error falls within the error band of the satellite measurement results, while retaining the orbit smoothness characteristics, thereby realizing high-precision absolute measurement based on the trajectory constraints of the differential satellite receiver.

[0053] The embodiment of the present invention uses the positioning result of the differential satellite receiver to replace the traditional CPIII control point + total station optical measurement method, so that the inertial / odometer combined trajectory after correcting the system error falls within the error band of the satellite measurement result, while retaining the track smoothness characteristics, thereby achieving high-precision absolute measurement based on the differential satellite receiver trajectory constraint. The process of parking and aligning the total station is eliminated, which significantly improves the efficiency of geometric parameter measurement operations.

[0054] In the above embodiment, the step 4 specifically includes:

[0055] Calculate the slope of the straight line and And then recursively calculate the angle change rate σ between the two sets of straight lines i (i.e. the equivalent gyro drift error of the inertial system); as shown in the following formula:

[0056]

[0057] Among them, σ i represents the ith angle change rate, σ i-1 Represents the i-1th angle change rate.

[0058] In the above embodiment, the step five specifically includes:

[0059] 1) Set σ i According to the time period, correct the gyro output of the inertial navigation system;

[0060] 2) Based on step 1), re-perform inertial / odometer combined navigation according to the method of step 1;

[0061] 3) Based on step 2), perform steps 3 to 4, and then go to step 1) until the obtained σ i If the value is less than the set correction judgment threshold ξ, the inertial / odometer combined trajectory falls within the error band of the satellite measurement result, and the trajectory correction ends.

[0062] In the above embodiment, the step 2 specifically includes:

[0063] 2.1 Given a sequence P consisting of a series of differential satellite positioning results GPS = {P1,P2,...P n}, and an error tolerance ε,P i is the position of the ith measurement;

[0064] 2.2 P1 and P n Mark as a reserved point;

[0065] 2.3 Calculation of P GPS All points to line segments The vertical distance d of the offline segment The farthest point P i ;

[0066] 2.4 If point P i The corresponding vertical distance d≤ε, then P1 and P are retained. n , delete P1 and P n All other points between two points; if d>ε, then P i To retain the point, recursively of Repeat steps 2.1 to 2.4;

[0067] 2.5 When the errors of all sub-segments are less than or equal to ε (that is, there is no farthest point corresponding to a value greater than ε), the calculation of the satellite similarity trajectory is completed and the satellite trajectory sequence is obtained.

[0068] According to an embodiment of the present invention, the step 1 specifically includes:

[0069] 1) Establishing an inertial / odometer Kalman filter combined navigation state space model, wherein the space model includes a state equation and a measurement equation;

[0070] 2) Use the gyroscope and accelerometer of the inertial navigation system to perform inertial navigation solution, and estimate the error state through Kalman filtering in combination with the model in step 1).

[0071] Specifically:

[0072] Establish the inertial / odometer Kalman filter combined navigation state space model.

[0073] The state space model consists of two parts: state equation and measurement equation:

[0074] First calculate the state equation X k =Φ k,k-1 X k-1 +w k-1 .

[0075] 1. Equation of state X k =Φ k,k-1 X k-1 +w k-1 The specific calculation of each variable is as follows:

[0076] 1.1 State quantity X k

[0077] State variables There are 21 dimensions in total, including:

[0078] Misalignment angle φ=[φ E φ N φ U ] Τ (Unit: rad), speed error δv n =[δV E δV N δV U ] T (Unit: m / s), inertial navigation position error Including latitude error (unit: rad), longitude error δλ (unit: rad), altitude error δh (unit: m), dead reckoning position error Including latitude error (Unit: rad), longitude error δλ D (Unit: rad), height error δh D (Unit: m), carrier system gyro drift ε b =[ε x ε y ε z ] T (Unit: rad / s), load system accelerometer zero bias (Unit: m / s 2 ) and odometer error κ D =[α θ δK D α ψ ] T , including the pitch angle α between the inertial navigation carrier coordinate system (b system) and the odometer coordinate system (m system) θ , heading angle α ψ and odometer scale factor error δK D .

[0079] X k and X k-1 are the state vectors estimated at time k and time k-1 respectively;

[0080] 1.2 State equation state transfer matrix Φ k,k-1

[0081] State equation state transfer matrix Φ k,k-1 Through the discretization calculation of F matrix, the F matrix is ​​specifically defined as:

[0082]

[0083] in:

[0084]

[0085] M ap =M1+M2,

[0086]

[0087] M vp =(v n ×)(2M1+M2),

[0088]

[0089] M pkD =M pvD M vkD ,

[0090] Where: (×) indicates calculating the antisymmetric matrix for the vector in brackets, Represents the direction cosine matrix from b system to n system (navigation coordinate system), For comparison; v E 、v N 、v U is the geographic velocity, unit: m / s; L is the latitude; h is the height; ω ie is the Earth's rotation angular rate; R Mh , R Nh are the principal curvature radius of the meridian plane including the altitude and the curvature radius of the meridian circle, v D Represents the odometer speed scalar.

[0091] 2. Calculate the measurement equation Z k =H k X k +V k

[0092] Measurement equation Z k =H k X k +V k The specific meanings of the variables are as follows:

[0093] 2.1 Measurement vector Z at time k k

[0094] The measurement vector Z at time k k The specific definition of is:

[0095]

[0096] Where: is the inertial navigation velocity vector including error, is the odometry velocity vector including error.

[0097] 2.2k time measurement matrix H k

[0098] The measurement matrix H at time k k The specific definition is:

[0099]

[0100] 2.3 Use Kalman filtering to estimate and correct the inertial navigation system error:

[0101] The gyroscope and accelerometer of the inertial navigation system are used to perform inertial navigation solution, and the error state is estimated through Kalman filtering in combination with the model in step 1. The execution process of the Kalman filter algorithm is as follows: Figure 1 As shown in the figure: Estimate the state vector for one-step forecast; is the optimal estimated state vector; P k,k-1 is the one-step prediction covariance matrix; P k is the optimal estimated covariance matrix; K k is the optimal gain matrix; R k is the measurement noise covariance matrix after discretization; Q k is the system noise covariance matrix after discretization.

[0102] Considering that the parameter estimation results are related to the carrier maneuver, and the parameter convergence requires a process, the P k The convergence of the diagonal elements is judged when When the corresponding state error is corrected, p k P k Diagonal elements, is the diagonal element convergence threshold.

[0103] According to another embodiment, a computer device is provided, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the method of the above embodiment is implemented when the processor executes the computer program.

[0104] In summary, the solution proposed in the embodiment of the present invention uses the differential satellite receiver positioning results to replace the traditional CPIII control point + total station optical measurement method, which significantly improves the measurement speed. And the inertial / odometer combined trajectory after correcting the system error falls within the error band of the satellite measurement result, while retaining the track smoothness characteristics, thereby achieving high-precision absolute measurement based on differential satellite receiver trajectory constraints.

[0105] Features described and / or illustrated above for one embodiment may be used in the same or similar manner in one or more other embodiments, and / or combined with or used in place of features in other embodiments.

[0106] It should be emphasized that the term "include / comprises" when used herein refers to the presence of features, integers, steps or components, but does not exclude the presence or addition of one or more other features, integers, steps, components or combinations thereof.

[0107] The above method of the present invention can be implemented by hardware, or by hardware combined with software. The present invention relates to such a computer-readable program, which, when executed by a logic component, enables the logic component to implement the above-mentioned device or component, or enables the logic component to implement the above-mentioned various methods or steps. The present invention also relates to a storage medium for storing the above program, such as a hard disk, a magnetic disk, an optical disk, a DVD, a flash memory, etc.

[0108] The many features and advantages of these embodiments are apparent from this detailed description, and thus the appended claims are intended to cover all such features and advantages of these embodiments that fall within their true spirit and scope. Furthermore, since numerous modifications and changes will readily occur to those skilled in the art, it is not intended that the embodiments of the invention be limited to the exact construction and operation illustrated and described, but rather all suitable modifications and equivalents falling within the scope thereof are intended to be covered.

[0109] Parts of the present invention that are not described in detail are well known to those skilled in the art.

Claims

1. A GNSS trajectory constraint absolute measurement correction method, characterized in that: The correction method comprises: Step 1: Obtain trajectory sequence through inertial / odometer dead reckoning, defined as P OD = {P OD1 ,P OD2 ,...P ODm }, where P ODi Represents the positioning point of the inertial / odometer combination; Step 2: Perform similarity adjustment on the differential satellite receiver positioning results to obtain a satellite trajectory sequence defined as P G = {P G1 ,P G2 ,...P Gl }, and the UTC time corresponding to each point; where P Gi Indicates the position obtained through similarity adjustment; Step 3: Search for P according to the UTC time OD The corresponding time position in the sequence P D = {P D1 ,P D2 ,...P l },{P D1 ,P D2 ,...P l }∈{P OD1 ,P OD2 ,...P ODm };P Di Indicates that from the search P OD The selected positioning points; Step 4: Based on the satellite trajectory sequence and the new sequence P D Table to obtain the angle change rate σ i ; Step 5: Correct the inertial / odometer combined navigation trajectory according to the angle change rate.

2. A GNSS trajectory constraint absolute measurement correction method according to claim 1, characterized in that: The step 4 specifically includes: Calculate the slope of the straight line and i∈[1,l-1], and recursively calculate the angle change rate σ between the two sets of straight lines i , as shown below:

3. A GNSS trajectory constraint absolute measurement correction method according to claim 1 or 2, characterized in that: The step five specifically includes: 1) Set σ i According to the time period, correct the gyro output of the inertial navigation system; 2) Based on step 1), re-perform inertial / odometer combined navigation according to the method of step 1; 3) Based on step 2), perform steps 3 to 4, and then go to step 1) until the obtained σ i If the value is less than the set correction judgment threshold ξ, the inertial / odometer combined trajectory falls within the error band of the satellite measurement result, and the trajectory correction ends.

4. The GNSS trajectory constraint absolute measurement correction method according to claim 1, characterized in that: The step 1 specifically includes: 1) Establishing an inertial / odometer Kalman filter combined navigation state space model, wherein the space model includes a state equation and a measurement equation; 2) Use the gyroscope and accelerometer of the inertial navigation system to perform inertial navigation solution, and estimate the error state through Kalman filtering in combination with the model in step 1).

5. A GNSS trajectory constraint absolute measurement correction method according to claim 4, characterized in that: The equation of state is constructed by: X k =Φ k,k-1 X k-1 +w k-1 In the formula, State variables Where the misalignment angle φ=[φ E φ N φ U ] Τ , speed error δv n =[δV E δV N δV U ] T , Inertial navigation position error Including latitude error Longitude error δλ, altitude error δh, dead reckoning position error Including latitude error Longitude error δλ D , height error δh D , carrier system gyro drift ε b =[ε x ε y ε z ] T , load system accelerometer zero bias and the odometer error κ D =[α θ δK D α ψ ] T , including the pitch angle α between the inertial navigation carrier coordinate system and the odometer coordinate system θ , heading angle α ψ and odometer scale factor error δK D . X k and X k-1 are the state vectors estimated at time k and time k-1 respectively; Φ k,k-1 is the state transfer matrix of the state equation; w k-1 is the system error.

6. A GNSS trajectory constraint absolute measurement correction method according to claim 4 or 5, characterized in that: The measurement equation is constructed by the following formula: Z k =H k X k +V k Among them, Z k is the measurement vector at time k; H k is the measurement matrix at time k, V k is the random noise vector measured at time k.

7. The GNSS trajectory constraint absolute measurement correction method according to claim 1, characterized in that: The step 2 specifically includes: 2.1 Given a sequence P consisting of a series of differential satellite positioning results GPS = {P1,P2,...P n }, and an error tolerance ε,P i is the position of the ith measurement; 2.2 P1 and P n Mark as a reserved point; 2.3 Calculation of P GPS All points to line segments The vertical distance d of the offline segment The farthest point P i ; 2.4 If point P i The corresponding vertical distance d≤ε, then P1 and P are retained. n , delete P1 and P n All other points between two points; if d>ε, then P i To retain the point, recursively of Repeat steps 2.1 to 2.4; 2.5 When the errors of all sub-segments are less than or equal to ε, the calculation of satellite similarity trajectories is completed and the satellite trajectory sequence is obtained.

8. A computer device comprising a memory, a processor and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the method according to claims 1 to 7 is implemented.

Citation Information

Cited By

  • High-speed rail seamless track displacement real-time detection system based on Beidou navigation

    CN120522736A