Train positioning and inertial navigation integrated navigation method
By combining the strap-inner inertial navigation system with the satellite navigation system, the Kalman filter is used to correct navigation errors in real time, solving the problem of insufficient accuracy in a complex geographical environment, and achieving high-precision and reliable train positioning.
Patent Information
- Application Number
- CN202411183413.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-27
- Publication Date
- 2024-11-12
AI Technical Summary
Traditional train positioning systems are prone to signal loss or poor accuracy in areas with complex geographical environments, and the positioning error of inertial navigation accumulates over time, making it difficult to independently complete high-precision positioning for a long time.
Using a combined navigation method of the strap-inner inertial navigation system and satellite navigation system, the difference in the information between the two is input through the Kalman filter, and the navigation results of the strap-inner inertial navigation system are corrected in real time, and the closed loop is used to improve autonomous navigation when the satellite navigation is invalid. Accuracy.
It realizes continuous acquisition of high-precision train positioning information in complex geographical environments, ensures the reliability and safety of the train operation control system, and avoids positioning loss or poor accuracy.
Smart Images

Figure CN118938281A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of inertial navigation, and in particular to a train positioning inertial satellite combined navigation method. Background Art
[0002] The normal and safe operation of the train operation control system requires real-time, accurate and reliable acquisition of train location, speed and other navigation information. The traditional train positioning system mainly obtains the train location and other control information through trackside equipment, but this positioning system has the disadvantages of large amount of maintenance and operation, high maintenance cost, and does not support dynamic traffic configuration changes of the line.
[0003] Satellite navigation and strapdown inertial navigation are currently the most common means of navigation and positioning. They can disclose high-precision navigation information such as position and speed for a long time during the movement of a train. The strapdown inertial navigation system is an autonomous navigation system that does not rely on any external information source during its operation. It can disclose full-parameter high-data-rate navigation information such as position, speed, heading, attitude, etc. for the carrier platform, and is a very reliable means of navigation and positioning.
[0004] However, satellite navigation also has disadvantages such as slow data update rate and susceptibility to interference. Especially in areas with complex geographical environments such as tunnels, mountainous areas, and forests, satellite signals often experience signal loss and signal quality degradation due to factors such as the number of satellites, satellite geometric distribution, and natural environment, resulting in loss of satellite navigation function or poor positioning accuracy. Inertial navigation has the problem of positioning errors accumulating and diverging over time, and the positioning accuracy after long-term autonomous operation is difficult to independently meet the needs of high-precision positioning. Therefore, it is urgent to design a train positioning inertial satellite combined navigation method to solve the above problems. Summary of the invention
[0005] The purpose of the present invention is to disclose a train positioning inertial satellite combined navigation method to solve the above-mentioned deficiencies in the prior art.
[0006] In order to achieve the above object, the present invention discloses the following technical solutions:
[0007] The following steps are involved:
[0008] S1: Operate the strapdown inertial navigation system and satellite navigation system;
[0009] S2: Using the difference between the position information of the strapdown inertial navigation system and the position information of the satellite navigation system as the measurement input of the Kalman filter;
[0010] S3: Correct the navigation result of the strapdown inertial navigation system in real time through the error values estimated by the Kalman filter, so as to output the final combined navigation result;
[0011] S4: When the satellite navigation system is valid, the positioning information of the integrated navigation result follows the positioning information of the satellite navigation system, and other navigation information such as speed and heading attitude adopt the results corrected in real time by the strapdown inertial navigation system;
[0012] S5: When the satellite navigation system is invalid or has poor accuracy, the error information estimated by the Kalman filter is closed-looped to the strapdown inertial navigation system to improve the navigation accuracy of the strapdown inertial navigation system in the autonomous navigation state. The combined navigation result is the result of autonomous navigation of the strapdown inertial navigation system.
[0013] The inertial-satellite combined navigation method can utilize the respective technical advantages of the strapdown inertial navigation system and the satellite navigation system, thereby overcoming the adverse effects of geographical and environmental factors on the train route and continuously obtaining high-precision train positioning information, thereby preventing the train positioning from being lost or having poor accuracy in areas with complex geographical environments, thereby ensuring the reliability and safety of the train operation control system.
[0014] The Kalman filter includes a Kalman filter error state differential equation and a filter model. The filter model adopts a strapdown inertial navigation system error equation group. The error equation group includes an attitude error equation, a velocity error equation and a position error equation.
[0015] The attitude error equation is Said and stated are respectively the projection and error of the angular velocity of the Earth system relative to the inertial system in the navigation system; and stated are respectively the projection and error of the angular velocity of the navigation system relative to the earth system in the navigation system; is the transfer matrix from the carrier system to the geographic system; the ε b is the gyro constant zero bias vector.
[0016] The velocity error equation is The δf t is the accelerometer measurement error vector; the δV t is the velocity error vector; the δg t is the projection of the accelerometer measurement error in the navigation system.
[0017] The position error equation is The δV E , the δV N and the V U is the error of east, north and vertical speed; M , the R N is the radius of curvature of the meridian and the meridian; and L is the latitude.
[0018] The Kalman filter system equation is The position error, attitude error, velocity error, gyro drift, and accelerometer bias of the strapdown inertial navigation system are used as state variables X(t), and the position error between the strapdown inertial navigation system and the satellite navigation system is used as an observation quantity. The position error, velocity error, attitude error, and inertial device error of the strapdown inertial navigation system are estimated in real time. The expression of X(t) is:
[0019] X(t)=[δλ δL δh δφ x δφ y δφ z δv e δv n δv u ε x ε y ε z Δ x Δ y Δ z ] T .
[0020] The F matrix is a dynamic coefficient matrix, which includes the position, attitude, velocity and error model of the inertial device of the strapdown inertial navigation system. The G matrix is an error distribution matrix, which is expressed as G=[σ r,1×3 , σ θ,1×3 , σ v,1×3 , σ ω,1×3 , σ f,1×3 ] T , the w matrix is Gaussian noise with unit variance.
[0021] The Kalman filter equation is discretized into a discrete Kalman filter equation group, and the discrete Kalman filter equation group is: Since the data processing interval of the strapdown inertial navigation system is very small, the state transition matrix Φ k+1,k It can be simplified to Φ k+1,k ≈I+F·Δt.
[0022] The Γ k is the system noise driving matrix, the W t is the system noise sequence, the V t is the observation noise sequence, and the W t , the V t Satisfy E(W i )=0, E(V i )=0, E(W i V j )=0.
[0023] The following steps are also included: For the train, the displacement observation in the vertical direction can introduce the height information of the height sensor, and the observation can be taken as The δλ is the latitude, the δL is the longitude error, and the δH is the height error. If there is no height sensor, this item can be ignored as an observation. The Kalman filter measurement matrix H is expressed as H = [I 3×3 , 0 3×12 ].
[0024] In the above technical solution, the present invention discloses a train positioning inertial satellite combined navigation method, which has the following beneficial effects:
[0025] 1. The inertial navigation combined with satellite navigation method can utilize the respective technical advantages of the strapdown inertial navigation system and the satellite navigation system to overcome the adverse effects of geographical and environmental factors on the train route and continuously obtain high-precision train positioning information, thereby preventing the loss of train positioning or poor accuracy in areas with complex geographical environments, thereby ensuring the reliability and safety of the train operation control system.
[0026] 2. The Kalman filter can fuse the strapdown inertial navigation system and the satellite navigation system by using the optimal estimation Kalman filtering algorithm to obtain the strapdown inertial navigation system error and the satellite navigation system error, thereby improving the accuracy of the combined navigation system of the strapdown inertial navigation system and the satellite navigation system through real-time feedback of the closed-loop error value.
[0027] 3. The discrete Kalman filter equations can handle time-varying linear systems, thereby estimating the current value of the state variable in a recursive form. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments recorded in the present invention. For ordinary technicians in this field, other drawings can also be obtained based on these drawings.
[0029] Figure 1 The present invention is a schematic diagram of the principle of the inertial navigation / satellite navigation combined navigation method disclosed in the embodiment of the train positioning inertial navigation and satellite combined navigation method of the present invention. DETAILED DESCRIPTION
[0030] In order to facilitate understanding of the present application, the present application will be described more fully below with reference to the relevant drawings. Embodiments of the present application are provided in the drawings. However, the present application can be implemented in many different forms and is not limited to the embodiments described herein. On the contrary, the purpose of disclosing these embodiments is to make the disclosure of the present application more thorough and comprehensive.
[0031] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art to which this application belongs. The terms used herein in the specification of this application are only for the purpose of describing specific embodiments and are not intended to limit this application.
[0032] The embodiment of the present invention discloses a train positioning inertial satellite combined navigation method. The navigation method can continuously obtain high-precision positioning information of the train, solving the problem of train positioning loss or poor accuracy in areas with complex geographical environments.
[0033] Figure 1 A schematic flow chart of the train positioning inertial satellite combined navigation method of this embodiment is shown.
[0034] Figure 1 The navigation method shown comprises the following steps:
[0035] S1: Make the strapdown inertial navigation system and satellite navigation system operate independently and output their respective navigation information.
[0036] S2: Select the difference between the position information of the strapdown inertial navigation system and the position information of the satellite navigation system as a measurement input of a Kalman filter.
[0037] S3: The navigation results of the strapdown inertial navigation system are corrected in real time through the error values estimated by the Kalman filter, thereby outputting the combined navigation results.
[0038] S4: When the satellite navigation system is effective, the positioning information of the combined navigation result follows the positioning information of the satellite navigation system, so that other navigation information such as speed and heading attitude adopt the results corrected in real time by the strapdown inertial navigation system.
[0039] S5: When the satellite navigation system is invalid or has poor accuracy, the error information estimated by the Kalman filter is closed-looped to the strapdown inertial navigation system to improve the navigation accuracy of the strapdown inertial navigation system in the autonomous navigation state, so that the combined navigation result is the result of autonomous navigation of the strapdown inertial navigation system.
[0040] Based on this, the navigation method of this embodiment can utilize the respective technical advantages of the strapdown inertial navigation system and the satellite navigation system, thereby overcoming the adverse effects of geographical, environmental and other factors on the train route and continuously obtaining high-precision train positioning information, thereby preventing the train positioning from being lost or having poor accuracy in areas with complex geographical environments, thereby ensuring the reliability and safety of the train operation control system.
[0041] Reference Figure 1The Kalman filter of this embodiment includes a Kalman filter error state differential equation and a filter model. The filter model adopts a strapdown inertial navigation system error equation group, and the error equation group includes an attitude error equation, a velocity error equation and a position error equation.
[0042] The Kalman filter can fuse the strapdown inertial navigation system and the satellite navigation system by utilizing the optimal estimation Kalman filtering algorithm, thereby obtaining the strapdown inertial navigation system error and the satellite navigation system error, thereby improving the accuracy of the combined navigation system of the strapdown inertial navigation system and the satellite navigation system by real-time feedback of the closed-loop error value.
[0043] The attitude error equation is: and are respectively the projection and error of the angular velocity of the Earth system relative to the inertial system in the navigation system; and are respectively the projection and error of the angular velocity of the navigation system relative to the earth system in the navigation system; is the transfer matrix from the carrier system to the geography system; ε b is the gyro constant zero bias vector.
[0044] The velocity error equation is: δf t is the accelerometer measurement error vector; δV t is the velocity error vector; δg t is the projection of the accelerometer measurement error in the navigation system.
[0045] The position error equation is δV E , δV N and V U is the error of east, north and vertical speed; R M , R N is the radius of curvature of the meridian and the meridian; L is the latitude.
[0046] The Kalman filter system equation is The position error, attitude error, velocity error, gyro drift, and accelerometer bias of the strapdown inertial navigation system are used as state variables X(t), and the position error between the strapdown inertial navigation system and the satellite navigation system is used as the observed quantity. The position error, velocity error, attitude error, and inertial device error of the strapdown inertial navigation system are estimated in real time. The expression of X(t) is:
[0047] X(t)=[δλ δL δh δφ x δφ y δφ z δv e δv n δvu ε x ε y ε z Δ x Δ y Δ z ] T .
[0048] The F matrix is a dynamic coefficient matrix, which includes the position, attitude, velocity and error model of the inertial device of the strapdown inertial navigation system. The G matrix is an error distribution matrix, which is expressed as G = [σ r,1×3 , σ θ,1×3 , σ v,1×3 , σ ω,1×3 , σ f,1×3 ] T , the w matrix is Gaussian noise with unit variance.
[0049] The Kalman filter equation is discretized into the discrete Kalman filter equation group. The discrete Kalman filter equation group is Since the data processing interval of the strapdown inertial navigation system is very small, the state transition matrix Φ k+1,k It can be simplified to Φ k+1,k ≈I+F·Δt.
[0050] The discrete Kalman filter equations are able to handle time-varying linear systems, thereby estimating the current values of state variables in a recursive form.
[0051] Γ k is the system noise driving matrix, W t is the system noise sequence, V t is the observation noise sequence, and W t 、V t Satisfy E(W i )=0, E(V i )=0, E(W i V j )=0.
[0052] The following steps are also included: For the train, the displacement observation in the vertical direction can introduce the height information of the height sensor, and the observation can be taken as δλ is the latitude, δL is the longitude error, and δH is the height error. If there is no height sensor, this item can be ignored as an observation. The Kalman filter measurement matrix H is expressed as H = [I 3×3 , 0 3×12 ].
[0053] Based on this, in the present embodiment, the strapdown inertial navigation system and the satellite navigation system operate independently and output their respective navigation information respectively; the difference between the position information of the strapdown inertial navigation system and the position information of the satellite navigation system is used as the measurement input of the Kalman filter; the navigation result of the strapdown inertial navigation system is corrected in real time by various error values estimated by the Kalman filter, thereby outputting the final combined navigation result; when the satellite navigation system is valid, the positioning information of the combined navigation result follows the positioning information of the satellite navigation system, and other navigation information such as speed and heading attitude adopts the result corrected in real time by the strapdown inertial navigation system; when the satellite navigation system is invalid or has poor accuracy, the error information estimated by the Kal man filter is closed-looped to the strapdown inertial navigation system, thereby improving the navigation accuracy of the strapdown inertial navigation system in the autonomous navigation state, and the combined navigation result is the result of autonomous navigation of the strapdown inertial navigation system.
[0054] Based on this understanding, the technical solution of the present invention can essentially or the part that contributes to the prior art can be embodied in the form of a software product. The computer software product can be stored in a computer-readable storage medium, such as a computer floppy disk, read-only memory (ROM), random access memory (RAM), flash memory (FLASH), hard disk or optical disk, etc., including a number of instructions for enabling a computer device (which can be a personal computer, a server, or a network device, etc.) to execute the methods of the various embodiments of the present invention.
[0055] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may include more other equivalent embodiments without departing from the concept of the present invention, and the scope of the present invention is determined by the scope of the appended claims.
Claims
1. A train positioning inertial satellite combined navigation method, characterized in that: The navigation method comprises the following steps: S1: Operate the strapdown inertial navigation system and satellite navigation system; S2: Using the difference between the position information of the strapdown inertial navigation system and the position information of the satellite navigation system as the measurement input of the Kalman filter; S3: Correct the navigation result of the strapdown inertial navigation system in real time through the error values estimated by the Kalman filter, so as to output the final combined navigation result; S4: When the satellite navigation system is valid, the positioning information of the integrated navigation result follows the positioning information of the satellite navigation system, and other navigation information such as speed and heading attitude adopt the results corrected in real time by the strapdown inertial navigation system; S5: When the satellite navigation system is invalid or has poor accuracy, the error information estimated by the Kalman filter is closed-looped to the strapdown inertial navigation system to improve the navigation accuracy of the strapdown inertial navigation system in the autonomous navigation state. At this time, the combined navigation result is the result of autonomous navigation of the strapdown inertial navigation system.
2. The train positioning inertial satellite integrated navigation method according to claim 1 is characterized in that: The Kalman filter includes a Kalman filter error state differential equation and a filter model. The filter model adopts a strapdown inertial navigation system error equation group. The error equation group includes an attitude error equation, a velocity error equation and a position error equation.
3. The train positioning inertial satellite integrated navigation method according to claim 2 is characterized in that: The attitude error equation is Said and stated are respectively the projection and error of the angular velocity of the Earth system relative to the inertial system in the navigation system; and stated are respectively the projection and error of the angular velocity of the navigation system relative to the earth system in the navigation system; is the transfer matrix from the carrier system to the geographic system; the ε b is the gyro constant zero bias vector.
4. The train positioning inertial satellite integrated navigation method according to claim 2, characterized in that: The velocity error equation is The δf t is the accelerometer measurement error vector; the δV t is the velocity error vector; the δg t is the projection of the accelerometer measurement error in the navigation system.
5. The train positioning inertial satellite integrated navigation method according to claim 2, characterized in that: The position error equation is Wherein, the δV E , the δV N and the V U is the error of east, north and vertical speed; M , the R N is the radius of curvature of the meridian and the meridian; and L is the latitude.
6. The train positioning inertial satellite integrated navigation method according to claim 1, characterized in that: The Kalman filter system equation is The position error, attitude error, velocity error, gyro drift, and accelerometer bias of the strapdown inertial navigation system are used as state variables X(t), and the position error between the strapdown inertial navigation system and the satellite navigation system is used as an observation quantity. The position error, velocity error, attitude error, and inertial device error of the strapdown inertial navigation system are estimated in real time. The expression of X(t) is X(t)=[δλ δL δh δφ x δφ y δφ z δv e δv n δv u ε x ε y ε z Δ x Δ y Δ z ] T .
7. The train positioning inertial satellite integrated navigation method according to claim 6, characterized in that: The F matrix is a dynamic coefficient matrix, which includes the position, attitude, velocity and error model of the inertial device of the strapdown inertial navigation system. The G matrix is an error distribution matrix, which is expressed as G=[σ r,1×3 , σ θ,1×3, σ v,1×3 , σ ω,1×3 , σ f,1×3 ] T , the w matrix is Gaussian noise with unit variance.
8. The train positioning inertial satellite integrated navigation method according to claim 6, characterized in that: The Kalman filter equation is discretized into a discrete Kalman filter equation group, and the discrete Kalman filter equation group is: Since the data processing interval of the strapdown inertial navigation system is very small, the state transition matrix Φ k+1,k It can be simplified to Φ k+1,k ≈I+F·Δt.
9. The train positioning inertial satellite integrated navigation method according to claim 8, characterized in that: The Γ k is the system noise driving matrix, the W t is the system noise sequence, the V t is the observation noise sequence, and the W t , the V t Satisfy E(W i )=0, E(V i )=0, E(W i V j )=0.
10. The train positioning inertial satellite integrated navigation method according to claim 1, characterized in that: The following steps are also included: For the train, the displacement observation in the vertical direction can introduce the height information of the height sensor, and the observation can be taken as The δλ is the latitude, the δL is the longitude error, and the δH is the height error. If there is no height sensor, this item can be ignored as an observation. The Kalman filter measurement matrix H is expressed as
