 Original Article
 Open access
 Published:
Semianalytical assessment of the relative accuracy of the GNSS/INS in railway track irregularity measurements
Satellite Navigation volume 2, Article number: 25 (2021)
Abstract
An aided Inertial Navigation System (INS) is increasingly exploited in precise engineering surveying, such as railway track irregularity measurement, where a high relative measurement accuracy rather than absolute accuracy is emphasized. However, how to evaluate the relative measurement accuracy of the aided INS has rarely been studied. We address this problem with a semianalytical method to analyze the relative measurement error propagation of the Global Navigation Satellite System (GNSS) and INS integrated system, specifically for the railway track irregularity measurement application. The GNSS/INS integration in this application is simplified as a linear timeinvariant stochastic system driven only by white Gaussian noise, and an analytical solution for the navigation errors in the Laplace domain is obtained by analyzing the resulting steadystate Kalman filter. Then, a time series of the error is obtained through a subsequent Monte Carlo simulation based on the derived error propagation model. The proposed analysis method is then validated through data simulation and field tests. The results indicate that a 1 mm accuracy in measuring the track irregularity is achievable for the GNSS/INS integrated system. Meanwhile, the influences of the dominant inertial sensor errors on the final measurement accuracy are analyzed quantitatively and discussed comprehensively.
Introduction
The integration of a Global Navigation Satellite System (GNSS) and an Inertial Navigation System (INS) has been widely used in weapon guidance, aviation engineering, and land mobile mapping to provide accurate georeferencing(Liu et al. , 2020; ElSheimy and Youssef , 2020). Attention is also paid to the outstanding shortterm relative measurement accuracy of the INS in inertial surveying applications (Zhang et al. , 2013; Zhu et al. , 2019; Zhang et al. , 2020). For example, an INS aided by GNSS and an odometer has successfully applied in precise engineering surveying, such as railway track irregularity measurement and road surface roughness measurement (Chen et al. , 2015; Chen et al. , 2018; Niu et al. , 2016).
The focus and accuracy requirement are very different for the above two kinds of applications. The second kind of applications pays more attention to the absolute accuracy, which is dominated by the midterm and longterm error components, while the railway track irregularity measurement, a typical precise inertial surveying application, is more concerned with the temporal or spatial relative measurement accuracy, like the smoothness of the estimated trajectory, as illustrated in Fig. 9 in the appendix. This difference is made more explicit in the example depicted in Fig. 1. The upper panel in this figure depicts two typical samples from the firstorder Gauss–Markov processes with the same covariance but different correlation times. Considering two positioning apparatuses that are corrupted by these two error processes; in this scenario, we would conclude that they have the same accuracy for georeferencing because these two stochastic processes have the same second moment, i.e., covariance matrix. In addition, it is obvious that the correlation between the values of \(y(t_1)\) and \(y(t_2)\) is higher than that between \(x(t_1)\) and \(x(t_2)\) for any two instants \(t_1\) and \(t_2\), i.e., x exhibits more rapid variations in magnitude than y. Physically, we would then expect the apparatus corrupted by error process y have better accuracy in measuring railway track irregularities, as depicted in the lower panel and discussed in the appendix. This example reveals that the covariance matrix or the propagation models of the aided INS navigation errors do not contain the information describing the temporal correlation characteristics, which actually determine the relative measurement accuracy.
For the research on precise railway track irregularity measurement by an aided INS, the following two questions are often asked

1.
Question 1: Is it possible to achieve 1 mm accuracy in track irregularity identification when the carrierphase differential GNSS/INS can only provide centimeterlevel accuracy?

2.
Question 2: What accuracy can be expected with a Track Geometry Measuring Trolley (TGMT, as shown in Fig. 10) that uses the given GNSS/INS integrated system?
These two questions are critical for the feasibility study and system design of a TGMT based on an aided INS. The example presented in Fig. 1 intuitively illustrates why the answer to the first question is positive, while obtaining insights into these questions requires analyzing the relative measurement error propagation of the aided INS.
The previous studies were almost concentrated on the absolute accuracy analysis, for example, the propagation of the covariance matrix \({\mathbf {P}}_e\) of the navigation errors, as discussed in the appendix. The time history of \({\mathbf {P}}_{e}\) portrays how the ensemble errors accumulate with time. However, this kind of analysis cannot answer the above two questions. As discussed in the appendix, it is \({\mathbf {P}}_{\Delta e}\) in (A.7) rather than \({\mathbf {P}}_{e}\) that characterizes the track irregularity measurement accuracy, while this information is not contained in \({\mathbf {P}}_{e}\). Therefore, it is impossible to evaluate the performance of a TGMT system by studying the time history of its covariance matrix.
The main difference between the present research and previous studies lies in the following: (1) The relative measurement accuracy instead of the absolute error budget of the GNSS/INS integrated system determines its performance in railway track irregularity parameter identification. Hence, we not only care about the error budget but also are interested in the correlation characteristics of the navigation errors. (2) A semianalytic approach is proposed to analyze the relative measurement accuracy of the GNSS/INS system, based on which the effects of the principal inertial sensor errors on the final railway track irregularity measurement accuracy are quantitatively evaluated.
The relative measurement accuracy analysis of an aided INS system was rarely studied, but with the emergence of precise engineering surveying using the inertial technique, this analysis has received more and more attention. In our previous work (Zhang et al. , 2020; Zhang et al. , 2017), we pointed out the importance of relative measurement accuracy in some mobile mapping systems and studied the shortterm relative measurement accuracy of the GNSS/INS system by reading the Allan variance plots of the positioning error samples of a real GNSS/INS system.
The errors in the position, velocity and attitude solution with a GNSS/INS integrated system arise from different sources, including alignment errors, inertial sensor errors, computational inaccuracy and imperfections in navigation aids, etc. Navigation error propagation is also affected by the host vehicle trajectory. It is well known that a complete determination of GNSS/INS navigation error propagation is a complex problem, and analytical solution is available only for some extremely simple cases. Maybeck (Maybeck , 1978) analyzed the navigation error of an INS aided by position data in a simplified channel . His work suggested that the analytic or at least semianalytic performance assessment of a GNSS/INS integrated system, specific for railway track irregularity measurement, is possible, as the host vehicle, i.e., the railway track trolley, moves along a simple and previously known trajectory and experiences only low dynamic motion in the surveying procedure.
The remainder of this paper is organized as follows. We first present a GNSS/INS integration algorithm specifically designed for railway track irregularity measurement and explicitly define the railway track irregularity measurement errors. Then, the system dynamic and measurement equations are simplified according to the railway track measurement condition, resulting in a timeinvariant linear system. Subsequently, the relative measurement accuracy is analyzed with a semianalytic approach. The relative error propagation analysis is then validated by a simulation. Finally, we use the semianalytic method to quantitatively analyze the effects of the principal inertial sensor errors on the railway track irregularity measurement.
Preliminaries
For the railway track irregularity measurement application, the GNSS carrier phase observations are postprocessed in the differential mode to provide the positions accurate to the centimeter level and then the results are fused with the Inertial Measurement Unit (IMU) data in a loosely coupled architecture. The speed measurements from odometers and a Nonholonomic Constraint (NHC) are used to enhance the navigation performance. In the following, the design of a navigation Kalman Filter (KF) for loose integration of the GNSS and INS is sketched, and the track irregularity measurement errors are explicitly defined.
Used coordinate systems
We first define the coordinate systems frequently used in this work.

the navigation frame (nframe): a local geographic reference frame whose origin coincides with the IMU measurement center, xaxis points toward geodetic north, zaxis is downpointing along the ellipsoid normal , and yaxis is directed east to form a righthanded frame, i.e., the NorthEastDown (NED) system.

the body frame (bframe): an IMU body frame whose axes are the same as the IMU’s body axes; it is the frame in which the accelerations and angular rates generated by the strapdown accelerometers and gyroscopes are resolved.

the vehicle frame (vframe): the host vehicle frame, whose xaxis is along the vehicle’s forward direction, zaxis points downward, and yaxis is directed outward to form a righthand system.
System models
For the GNSS/INS integrated KF design, the error state vector is defined as
In this definition, \(\delta \varvec{r}^n = [\begin{matrix} \delta r_N&\delta r_E&\delta r_D \end{matrix}]^\text {T}\) and \(\delta \varvec{v}^n = [\begin{matrix} \delta v_N&\delta v_E&\delta v_D \end{matrix}]^\text {T}\) are the INSderived position and velocity errors in the nframe, respectively, and \(\delta h = \delta r_D\). \(\varvec{\phi } = [\begin{matrix} \phi _N&\phi _E&\phi _D\end{matrix}]^\text {T}\) is the threedimensional attitude error vector, including tilt errors and the azimuth error (Benson , 1975). \(\delta \varvec{b}_g\) and \(\delta \varvec{b}_a\) are the errors of the gyroscope and accelerometer biases, respectively. The gyroscope and accelerometer scale factor and crosscoupling errors are not included in this error state vector, for their influence on the final navigation solution depends on the host vehicle maneuvers. The TGMT experiences only low and weak maneuvers when it moves along the rails, and therefore the scale factor and crosscoupling error of the highgrade IMU can be safely neglected. The error state vector differential equation is written as
where \({\mathbf {F}}\) is the system matrix describing the system dynamics, \({\mathbf {G}}\) is the system noise distribution matrix, and \(\varvec{w}\) is the system noise vector. To obtain the model for an aided INS system the time derivative of each state variable is calculated. The position, velocity and attitude error differential equations are
where \(\varvec{\omega }_{en}^n\) is the angular rate vector of the nframe with respect to the earth frame in the nframe and \(\delta \varvec{\theta } = [\begin{matrix} \delta \lambda \cos \varphi&\delta \varphi&\delta \lambda \sin \varphi \end{matrix}]^\text {T}\), where \(\varphi\) denotes the latitude and \(\delta \varphi\) and \(\delta \lambda\) are the errors in the latitude and longitude, respectively. \({\mathbf {C}}_b^n\) is the bframe to nframe coordinate transformation matrix; \(\varvec{f}^b\) is the specific force vector in the bframe, where \(\delta \varvec{f}^b\) is its error vector in the bframe and \(\varvec{f}^n\) denotes the specific force in the nframe; \(\varvec{\omega }_{ie}^n\) is the earth angular rotation rate vector in the nframe; \(\varvec{v}^n\) is the velocity vector in the nframe; \(\delta \varvec{\omega }_{ie}^n\) and \(\delta \varvec{\omega }_{en}^n\) denote errors of \(\varvec{\omega }_{ie}^n\) and \(\varvec{\omega }_{en}^n\), respectively; \(\delta \varvec{g}_p^n\) is the local gravity error vector in the nframe; \(\varvec{\omega }_{in}^n\) is the angular velocity vector, \(\varvec{\omega }_{in}^n = \varvec{\omega }_{ie}^n + \varvec{\omega }_{en}^n\) with the corresponding error denoted by \(\delta \varvec{\omega }_{in}^n\); and \(\delta \varvec{\omega }_{ib}^b\) refers to the gyro measurement errors. More details on the above three equations can be found in (Benson , 1975; Shin , 2005).
The residual inertial sensor errors are modeled as
where \(\varvec{w}_a\), \(\varvec{w}_g\) are threeelement vectors representing the white noise component of the accelerometers and the gyro measurements, respectively. The residual biases of the gyros and accelerometer are modeled as the firstorder Gauss–Markov process
where \(T_{gb}\) and \(T_{ab}\) are the correlation times and \(\varvec{w}_{gb}\) and \(\varvec{w}_{ab}\) are the corresponding driving white noise of strength \(2 \sigma ^2/T\), with \(\sigma\) being the root mean squared value of the process.
Measurement models
For a TGMT the available external measurements include the GNSSderived position and the speed from the odometer and NHC. The models for these observables are given below.
GNSS position update
The position of a GNSS antenna is related to the INS position by taking into account the lever arm as follows [(Teunissen and Montenbruck , 2017), p. 831]:
where \(\varvec{r}_{G}\) and \(\varvec{r}_{I}\) are the position vectors of the GNSS antenna phase center and the IMU measurement center, respectively, which are expressed as the latitude \(\varphi\), longitude \(\lambda\) and height h. \(\varvec{l}^b\) is the lever arm from the IMU center to the GNSS antenna phase center in the bframe, which can be accurately measured. \({\mathbf {D}}^{1} = \text {diag}\left( \left[ \frac{1}{R_M+h} \frac{1}{\left( R_N+h\right) \cos \varphi } 1\right] ^\text {T}\right)\), a diagonal matrix that converts the delta position in meter to delta latitude, delta longitude in radians and delta height in meter, where \(R_M\) and \(R_N\) are, respectively, the meridian and prime vertical radii of the curvature.
Then, the measurement innovation vector comprises the difference between the GNSS and the INSderived positions, and the measurement model can be derived by perturbation as
where \(\hat{\varvec{r}}_{G}\) is the estimated position of the GNSS antenna center, \(\tilde{\varvec{r}}_{G}^n\) is the position measurement provided by the GNSS receiver, \(\varvec{n}_{r}\) denotes the GNSS position measurement noise in meter, modeled as Gaussian white noise with \(\varvec{n}_r\sim N({\mathbf {0}}, {\mathbf {R}}_r)\), which is adequate if the GNSS sampling rate is below 1 Hz (Niu et al. , 2014).
Velocity update in the vehicle frame
The host vehicle, i.e., the TGMT, is a specifically designed trolley (as depicted in Fig. 10) that differs from civilian land vehicles since it cannot change its course arbitrarily. It can keep rigid contact with the rails in both lateral and vertical directions when moving along the track and conforms to the NHC quite well even when railway track deformation exists. More details on the TGMT can be found in (Chen et al. , 2015; Chen et al. , 2018). The trolley has only an alongtrack speed, which can be obtained from an odometer sensor, and the velocities in both crosstrack and vertical directions are zero. Therefore, the velocity measurement in the vframe can be written as
where \(\tilde{\varvec{v}}^v_\text {wheel}\) denotes the velocity measurement vector in the vframe; \(v_\text {odo}\) represents the alongtrack velocity derived from the odometer output, and \(\varvec{n}_{v}\) is the velocity measurement noise with \(\varvec{n}_v\sim N({\mathbf {0}}, {\mathbf {R}}_v)\). Note that the noise strength of the last two components of \(\varvec{n}_{v}\) are different from that of the first component and should be set according to the NHC condition.
The relationship between the velocities of the trolley wheel and the IMU is expressed as
where \(\varvec{l}_\text {wheel}^b\) is the leverarm vector from the IMU measurement center to the wheel sensor in the bframe; \({\mathbf {C}}_b^v\) is the bframe to vframe coordinate transformation matrix, which can be computed from the misalignment angles of the vframe with respect to the bframe; and the estimated velocity at the wheel point is denoted by \(\hat{\varvec{v}}_\text {wheel}^v\). The vframe velocity error measurement model can be expressed as
Errors of the optimal position estimates
In the GNSS/INS integrated solution, the optimal position estimate is obtained by subtracting the optimal estimate of the INSderived position error from the INSderived position solution as
where \(\hat{\varvec{r}}_\text {est}(t)\) denotes the optimal position estimate from the aided INS, with the subscript ‘ est’ indicating the optimal estimate; \(\hat{\varvec{r}}(t)\) is the INSindicated position solution, which contains errors \(\delta \varvec{r}\); and \(\hat{\delta \varvec{r}}\) is the optimal estimate of \(\delta \varvec{r}\) from the datafusion KF. The error in the position estimate, denoted by \(\delta \hat{\varvec{r}}_\text {est}\), is defined as
The INSderived position error is defined as
where \(\varvec{r}_\text {real}(t)\) is the true position vector of the IMU. The best estimate \(\hat{\delta \varvec{r}}(t)\) also contains an estimation error, represented as
Substituting (15) and (17) into (16) yields
A comparison of (18) and (19) shows that the error of the estimated position of the integrated system is exactly the estimation error of the position state variable \(\delta \varvec{r}(t)\), i.e., \(\delta \hat{\varvec{r}}_\text {est}(t) = \delta [\hat{\delta \varvec{r}}(t)]\). Thus, \(\delta \hat{\varvec{r}}_\text {est}(t)\) is used in the following error propagation modeling.
Errors of the track irregularity estimates
As introduced in the appendix, the alignment and vertical irregularities of the railway track are both defined as differential versines in (A.2), namely, track irregularity is a relative quantity. The track irregularity measurement error with the GNSS/INS system should be evaluated by the relative navigation error as defined in (A.5). Assuming the trolley moves at a constant speed, the railway track irregularity measurement error can be computed as differential navigation errors, denoted by \(\triangledown \hat{\varvec{r}}_\text {est}\):
where \(t \in \text {T}\), \(\omega _i \in \Omega\); \(\delta \hat{\varvec{r}}_\text {est}\) is a stochastic process that is a function defined on the product space \(\text {T}\times \Omega\), where \(\Omega\) is a fundamental sample space and \(\text {T}\) is a subset of the real line denoting a time set of interest.
Therefore, \(\triangledown \hat{\varvec{r}}_\text {est}\) is also a stochastic process, and contains all necessary information to completely describe the railway track irregularity measurement accuracy of a TGMT. It is clear that the objective of the performance analysis of a TGMT based on an aided INS in measuring the track irregularity is to completely characterize the relative error process \(\triangledown \hat{\varvec{r}}_\text {est}(t, \omega )\). In the subsequent analysis, we study the second moment, i.e., covariance matrix, of \(\triangledown \hat{\varvec{r}}_\text {est}\) to evaluate the measurement performance of a given TGMT. The covariance matrix of the measurement errors is defined as
with
Proposed method
Equations (3) to (5) describe the INS error dynamics using a set of nonhomogeneous differential equations with timevarying coefficients. The full determination of the INS error propagation is too complicated when taking into account the real trajectories and maneuvers. In this case, we generally use a simulation approach to aid the analysis (Titterton and Weston , 2004; Groves , 2008). The situation becomes much more complex for an aided INS because the integrated navigation solution is affected not only by INS error sources but also by the external measurement noises. Fortunately, in the railway track surveying application, the nominal trajectory and motion of the host track trolley are simple and almost deterministic, which reduces the complexity and makes the analytic assessment possible.
Figure 2 depicts a flowchart of the semianalytic assessment of the relative measurement accuracy with the aided INS in measuring railway track irregularity. The procedure consists of an analytic assessment phase (the upper part of the figure) and a Monte Carlo simulation phase (the lower part). First, the system model and measurement model are simplified according to the several assumptions that hold in the specific railway surveying scenario. Then the coupling between the channels of the INS error model vanishes, and the error state dynamics is reduced to a linear timeinvariant stochastic system driven only by white Gaussian noise, as enclosed by the dashed lines in the figure. The simplified INS error differential equations are solved in the Laplace domain, where \({\mathbf {H}}_\text {INS}(s)\) represents the transfer function. The Laplace transformation of the steadystate KF estimator is performed to yield the optimal estimate, where \({\mathbf {H}}_\text {KF}(s)\) characterizes the transfer function. An analytical solution of the navigation errors in the Laplace domain, i.e., \(\delta \hat{\varvec{r}}(s)\), is obtained as the difference between \(\delta \varvec{r}(s)\) and \(\hat{\delta \varvec{r}}(s)\).
The Monte Carlo simulation part, enclosed in the gray box, is performed as follows: create a transfer function model based on the derived \(\delta \hat{\varvec{r}}(s)\) model; then, use the simulated white noise series as the input to generate the navigation error samples, i.e., the system responses; and finally, evaluate the relative measurement accuracy based on the output navigation error samples. More details on the simulation part are given in subsequent sections.
Simplification for the railway measurement case
Assumption 1
The track trolley is assumed to move uniformly in a straight line in the southnorth direction.
This assumption is based on the following facts: Highspeed railway track is usually designed with a very large radius of curvature in both the horizontal and vertical profiles and with a slope gradient smaller than 1.5%. The longest chord in railway track irregularity measurements does not exceed 300 m; thus, it is reasonable to simplify such a short curve section to a straight line and to assume that the host vehicle moves uniformly in southnorth direction and remains level, in which case the attitude matrix \({\mathbf {C}}_b^n = {\mathbf {I}}\). As defined in appendix, the horizontal railway track deformation refers to the deviation of rails from its nominal position in the lateral and vertical directions. When the trolley moves in the southnorth direction, we can evaluate the horizontal and vertical irregularity measurement accuracy by directly analyzing the east and vertical positioning errors, respectively. Thus, this assumption would simplify the following analysis. In addition, the trolley moves at a low speed, and its attitude changes slowly, which makes the dynamicsinduced errors (such as the effects of the scale factor and crosscoupling) negligible.
Assumption 2
The IMU is mounted with its sensitive axes perfectly aligned with the host vehicle axes, i.e., the bframe is coincident with the vframe. In this case \({\mathbf {C}}_b^v\) becomes the identity matrix.
This assumption is reasonable because the IMU mounting angles can be estimated and compensated for with sufficient accuracy, as discussed in (Chen et al. , 2020)
Assumption 3
Lever arms of the GNSS antenna and odometer are all zeros, and GNSS positions with centimeter accuracy, obtained by the postprocessed kinematic, are available all the time, as the lever arms can be measured with sufficient accuracy and the related effect can be corrected in practice.
Assumption 4
The local gravity uncertainty is assumed to be much smaller than the accelerometer measurement error and is therefore negligible.
System model simplification
The performance of the aided INS is also influenced by the real trajectories and maneuvers. We list the key information on the trajectory, inertial sensor errors, and absolute navigation error as follows:

mean position of the trajectory: latitude = 30\(^\circ\), longitude = 114\(^\circ\), h = 20 m.

mean absolute positioning error: \(\delta r_N\) = 0.01 m, \(\delta r_E\) = 0.01 m, \(\delta r_D\) = 0.02 m.

velocity: \(v_N\) = 1 m/s, \(v_E\) = 0 m/s, \(v_D\) = 0 m/s.

mean velocity error: \(\delta v_N\) = 0.002 m/s, \(\delta v_E\) = 0.002 m/s, \(\delta v_D\) = 0.002 m/s.

mean attitude error: \(\phi _N\) = 0.003\(^\circ\), \(\phi _E\) = 0.003\(^\circ\), \(\phi _D\) = 0.005\(^\circ\).

gyro bias: \(\delta \omega _{ib}^b\) = 0.01 \(^\circ /h\).

accelerometer bias: \(\delta f^b\) = 10 mGal.

local gravity value: 9.78 m/s\(^2\).
We can calculate the magnitude of each term in the INS error differential equations by substituting the parameters listed above. The error terms with a magnitude smaller than 10% of the predominant term are considered insignificant terms and thus are neglected in the following analysis. The inertial sensor error terms \(\delta \varvec{\omega }_{ib}^b\) and \(\delta \varvec{f}^b\) are always kept. As a result, the INS error differential equations from (3) to (5) can be simplified as
where \(\delta f_N\), \(\delta f_E\), \(\delta f_D\) are the accelerometer measurement errors in the north, east, and vertical directions, respectively. \(\delta \omega _{ib,N}^n\), \(\delta \omega _{ib,E}^n\), \(\delta \omega _{ib,D}^n\) are the gyroscopic measurement errors in the north, east, and vertical directions, respectively. After simplification, as shown in (23), the coupling between channels vanishes, and each channel can be analyzed separately.
Measurement model simplification
A similar simplification can be carried out for measurement Eqs. (10) and (14) by taking into account the assumptions and trajectory information listed above, yielding
Measurement error propagation model
The navigation error propagation modeling of the GNSS/INS is analyzed in the vertical and horizontal channels. In the following, the details on the vertical channel analysis are presented, while the analysis of the horizontal channel is similar and given in the appendix.
For the vertical channel analysis, in addition to the height and vertical velocity errors, the easting gyro bias \(\delta b_{gE}\) and vertical accelerometer bias \(\delta b_{aD}\) should be augmented into the error state vector. Additionally, since the NHC is induced as a navigation aid, the attitude error term \(\phi _E\) should be augmented. Thus, the error state vector and the related state dynamics model can be written as
with
where the subscript ‘D’ denotes the down direction and \(\varvec{w}_D(t)\) represents the driving white Gaussian noise of strength \({\mathbf {Q}}_D\):
where \(\delta b_{gE}\) is modeled as a firstorder Gauss–Markov process with correlation time \(T_{gb}\) and driven by white Gaussian noise process \(w_{gbE}\). The residual bias in the vertical accelerometer \(\delta b_{aD}\) is modeled as a firstorder Gauss–Markov process with correlation time \(T_{ab}\) and driven by white Gaussian noise process \(w_{abD}\). \(w_{aD}\) is the white Gaussian noise that corrupted the vertical accelerometer measurement. \(w_{gE}\) is the white Gaussian noise that corrupted the gyro measurement in the east direction.
The measurements in the KF for the aided INS in the vertical channel includes the height difference between the INS and GNSS and the vertical velocity difference between the INS and the NHC. According to (25), the velocity measurement equation can be written as
where \(n_{vD}\) is the vertical component of \(\varvec{n}_{v}\) in (12) and represents the measurement uncertainty of the acrosstrack zero velocity. According to assumption 1, the host vehicle is assumed to move in the southnorth direction, in which case the east velocity shall be zero. Thus, (31) can be simplified as
Therefore, the measurement equation for the aided INS in the vertical channel can be written as
where \({\mathbf {z}}_D = \left[ \begin{matrix} z_h&z_{vD}\end{matrix}\right] ^\text {T}\), \({\mathbf {n}}_D = \left[ \begin{matrix} n_{rD}&n_{vD}\end{matrix}\right] ^\text {T}\)
However, if the vehicle moves with a nonzero constant heading angle rather in the southnorth direction, then \(v_E \ne 0\). In this case the simplification from (31) to (32) is not valid and the measurement Eq. (31) should be used.
The state dynamics equations of the continuous KF are given by
It is obvious from Eqs. (28) and (34) that \({\mathbf {F}}_D\), \({\mathbf {G}}_D\), \({\mathbf {H}}_D\) are all constant matrices; \({\mathbf {R}}_D\) and \({\mathbf {Q}}_D\) are constant and diagonal matrices. The filter gains converge to steadystate values in a short time, resulting in constant matrices \({\mathbf {P}}\) and \({\mathbf {K}}\). The matrix \({\mathbf {P}}\) can be calculated by solving the continuous matrix Riccati differential equation \(\dot{{\mathbf {P}}}(t) = {\mathbf {0}}\). The gain matrix \({\mathbf {K}}_D\) in this case is a 5by2 matrix.
Taking the Laplace transform of Eq. (27) yields the related solution in the Laplace domain:
The expansion of the above formula can be written as
where \(\gamma _{gb} = \frac{1}{T_{gb}}\), \(\gamma _{ab} = \frac{1}{T_{ab}}\). By taking the Laplace transform of Eq. (33) and substituting (37) into the transformed equation we obtain \(\varvec{z}_D(s)\), whose expansion can be written as
Solving Eq. (36) in the Laplace domain yields
Subtracting the height component \(\hat{\delta h}(s)\) in vector \(\hat{\varvec{x}}_D(s)\) from \(\delta h(s)\) in (37) yields the height estimate error of the aided INS, \(\delta {\hat{h}}(s)\), which is a linear function of \(\varvec{w}_D(s)\), written as
where \(H_{aD}\), \(H_{gE}\), \(H_{gbE}\), \(H_{abD}\), \(H_{nrD}\), and \(H_{nvD}\) are the related coefficients of the noise terms. The above equation is the error propagation model of the aided INS in the vertical channel in the Laplace domain. It tells that the height error of the GNSS/INS integration for measuring the railway track irregularity can be regarded as a timeinvariant stochastic system with the white noise as the system input. The detailed expression of \(\delta {\hat{h}}(s)\) is a bit complicated, and the related derivation can be got by a symbolic operation with the MATLAB software.
Relative measurement accuracy analysis
The position error solution \(\delta {\hat{r}}_\text {est}(s)\) in the Laplace domain has been obtained. Theoretically, the corresponding analytic solutions in the time domain, denoted by \(\delta {\hat{r}}_\text {est}(t)\), can be obtained by an inverse Laplace transform. Then, we can completely evaluate the relative measurement accuracy of the aided INS according to (A.5) and (A.7). Unfortunately, obtaining this analytic expression \(\delta {\hat{r}}_\text {est}(t)\) is impossible because the inverse Laplace transformation of white noise in Eqs. (41) and (B.12) does not lead to an explicit analytic expression. Therefore, the remainder analysis should be performed with a Monte Carlo simulation to generate the samples of \(\delta {\hat{r}}_\text {est}(t)\), as depicted in Fig. 2.
The Monte Carlo simulation relies on repeated random sampling to obtain numerical results, which is helpful in understanding the behaviors of a stochastic system that are not amenable to analysis by the usual direct mathematical methods (Brown and Hwang , 2012). Since white Gaussian noise is a stationary and Gaussiandistributed random process with a constant spectral density function over all frequencies, if it is put into a linear timeinvariant system, the system output will also be stationary and Gaussian distributed. It is evident from (41), (B.12) and (20) that \(\triangledown \hat{\varvec{r}}_\text {est}\) will also be a stationary, Gaussiandistributed, and ergodic random process. In that case, we would be able to conduct the performance analysis of the relative measurement accuracy with sufficiently long samples \(\delta \hat{\varvec{r}}_\text {est}(t)\). The analysis procedure is as follows:

(1)
Use the MATLAB function tf to create a transfer function model based on the error propagation model (41) and (B.12) in the Laplace domain.

(2)
Simulate the input white noise samples, including the system noise, measurement noise, and driving noise of the firstorder Gauss–Markov process; the corresponding parameters needed are listed subsequently.

(3)
Use the MATLAB function lsim to generate the time response of the dynamic system (generated in step 1) to the input stimuli (the output in step 2), obtaining navigation error samples of the aided INS in the time domain.

(4)
Calculate the railway track irregularity measurement error \(\triangledown \hat{\varvec{r}}_\text {est}\) in (20) and its corresponding covariance matrix \({\mathbf {P}}_\text {ir}\) in (21).
The information needed for generating the input white noise are listed as follows:

Angular Random Walk (ARW) = 0.002 \(^\circ /\sqrt{h}\), Velocity Random Walk (VRW) = 0.001 \(m/s/\sqrt{h}\).

\(T_{gb}\) = 1000 s, \(\sigma _{gb}\) = 0.005 \(^\circ /h\), \(T_{gb}\) = 1000 s, \(\sigma _{gb}\) = 25 mGal

\(n_{rE}\) = 1 cm/\(\sqrt{Hz}\), \(n_{rD}\) = 2 cm/\(\sqrt{Hz}\), \(n_{v}\) = 0.1 mm/s/\(\sqrt{Hz}\)
Figure 3 is a sample of the aided INS positioning error process in the lateral and vertical directions. In this figure, the navigation errors are plotted versus the travel distance, which is obtained from the calibrated odometer sensor. Since the positioning error in the alongtrack direction has little influence on the track irregularity measurement accuracy, it is not included in this figure. The first observation is that the error sequence varies within 1 cm and shows an explicit spatial correlation.
Based on the generated navigation error samples, we can calculate the railway track irregularity measurement error \(\triangledown \hat{\varvec{r}}_\text {est}\) as introduced in the above step 4. Figure 4 is a histogram of \(\triangledown \hat{\varvec{r}}_\text {est}\) in the east and vertical directions, which are related to the shortwave alignment and longitudinal direction, respectively, illustrating the distribution of \(\triangledown \hat{\varvec{r}}_\text {est}\). They approximately follow the Gaussian distribution, as expected. The results show that 1 mm accuracy is achievable in vertical and horizontal track irregularity measurements with a navigationgrade IMU aided by a carrierphase differential GNSS and the NHC. This result answers the first question raised in the introduction section.
Validation and discussion
In this section, we employ a full simulation approach to validate the results obtained from the proposed semianalytical error propagation model. Figure 5 depicts the validation flowchart. The previous analysis adopted a semianalytical approach where the analytical method was aided by a simulation technique in the last step. The simulation method encompasses a system simulation where the actual filter algorithm is embedded and the effects of nonlinearities in the system are kept. The simulated raw IMU data and navigation aids corrupted by different error terms are processed by a full comprehensive aided INS algorithm, i.e., the datafusion KF, and based on its output errors; the irregularity measurement errors are analyzed. The results from these two approaches are finally compared to evaluate the feasibility of the semianalytical method.
Aided INS raw data simulation
The aided INS data simulation software is developed at the GNSS Research Center of Wuhan University. The software consists of an IMU data simulator, navigation aiding simulator, error source simulator, and reference navigation calculator. It can generate the outputs of three orthogonal gyros and three orthogonal accelerometers, together with the navigation aid that includes position and velocity measurements via the userdefined trajectory and motion. The perfect inertial sensor output without corruption is first derived with the inverse principle of the INS. The simulated perfect IMU data are then integrated forward with time through the INS mechanization algorithm by setting the initial navigation state to generate the true navigation solutions as the navigation reference truth. The error source simulator is designed to generate several typical stochastic processes to model the inertial sensor errors and measurement noise, including white noise, random walk, and the firstorder Gauss–Markov process, by using the corresponding parameters. The simulated error terms perturbing the gyros and accelerometers are added to the perfect inertial sensor outputs to yield the noise corrupted IMU data. The noise corrupted navigation aid, such as position measurement, can be achieved by adding additive noise terms to the perfect aid samples.
Simulation settings
The host vehicle trajectory and motion settings for the aided INS data simulation are consistent with the assumptions and settings in the proceeding section for error propagation modeling. The host vehicle is assumed to move in a straight line with a constant speed in the north direction and remain level. The motion details are summarized in Table 1. At the beginning, the vehicle remains stationary for ten minutes to finish the static alignment, followed by an alternating accelerating dynamic motion to make the KF converge to a steady state in a short time. Finally, it accelerates from rest at 0.2 \(m/s^2\) for a period of 5 s, reaching a speed of 1 m/s, and then maintains uniform motion in a straight line at this velocity for 10,000 s. Only the navigation error of the uniform motion section is studied in detail in the following sections. The error terms that perturb the onboard IMU and the navigation aids are set to the same values as those for the preceding error propagation modeling analysis. The simulated IMU dataset is sampled at 200 Hz.
Simulated data processing
The simulated aided INS data are processed with the postprocessing software InsRail developed at the GNSS Research Center of Wuhan University. InsRail contains three function modules: post GNSS positioning process, aided INS data fusion, and railway track geometry analysis. The fusion of the GNSS positioning solutions and the raw inertial dataset is implemented in a loosely coupled manner. As the basis of the integrated processing modular of InsRail, the extended KF is designed based on 21dimensional error state vectors, e.g., errors of the position, velocity and attitude, biases and scale factors of the gyros and accelerometers. Moreover, the RauchTungStriebel (RTS) backward smoothing algorithm is applied in the software to achieve a high accuracy in the smoothed solutions. InsRail also supports other aids for the INS, such as the Zerovelocity Update (ZUPT), velocity update, and NHCs, to improve the aided INS performance. To be consistent with the analytic assessment based on the error propagation model, the simulated aided INS data are processed under the forward Kalman filtering mode.
Simulation results
Figure 6 shows the Short wavelength Track Irregularity (STI) measurement error distribution in both alignment (or lateral) and longitudinallevel (vertical) directions. It illustrates that the measurement errors of the GNSS/INS integrated system in the simulation case closely follow a Gaussian distribution and are consistent with the those obtained from the semianalytical approach, as shown in Fig. 4. It should be noted that the STI measurement is used here as an example, and a similar figure can also be plotted for the Long wavelength Track Irregularity (LTI) measurement. The statistical values of the measurement errors from both the semianalytical and simulation approaches are listed in Table 2, which demonstrates that the consistence between these two methods is better than 85%. This comparison validates the feasibility of the proposed semianalytical approach.
It is notable that the measurement errors from the semianalytical approach are slightly greater than those in the simulation. This can be explained as follows: the coupling between channels (i.e., axes) of the INS is ignored in the error propagation modeling procedure; the original weak observability of some navigation states across an axis is reduced or lost; and the loss of state observability causes the KF to lose the opportunity for state correction, lowing the final estimation accuracy slightly. In the simulation full coupling between channels has been considered, resulting in better results.
Validation in field tests
The proposed method and the related measurement accuracy analysis can also be verified through field tests, and the results were reported in our previous work (Chen et al. , 2015; Chen et al. , 2018). The TGMT based on a GNSS/INS configuration was evaluated comprehensively for the first time in November 2013 in the newly built LanzhouUrumqi high speed railway. The LanzhouUrumqi high speed passenger railway runs from Lanzhou to Urumqi in northwestern China with a designed operation speed of 250 km/h. In the experiment, the track section of about 1000 m was surveyed. The key information on the experiment and equipment used is listed below:

GNSS/INS integrated system: a navigation grade Positioning and Orientation System (POS) which integrates a Ring Laser Gyro (RLG) based IMU and a highprecision NovAtel GNSS OEM6 receiver.

Independent reference: a classical TGMT using high precision total station was used to provide alignment reference values accurate to 1.4 mm. A Trimble DiNi digital level was used to obtain the referenced vertical irregularity that is accurate to about 0.3 mm.

GNSS base station receiver: Trimble NetR9 GNSS reference receiver.

GNSS antenna: NovAtel GPS702GGL.
Figure 7 compares the STI measurements by the TGMT using GNSS/INS integrated system with the independent reference values obtained with the high precision geodetic surveys. It shows that the STI measurements in both vertical and alignment directions are accurate to 1 mm at 98% confidence level, which are consistent with the semianalytical and simulation results. In this figure, we take the STI result as an example, more details on the field tests and results can be found in (Chen et al. , 2018). In a field test, Dead Reckoning (DR) using the GNSS/INS integrated attitude and the travel distance is suggested to exploit the NHC’s potential to the fullest and ensure the consistency between the semianalytical analysis and the field tests.
Discussion
In the error propagation modeling, the semianalytical method is used, which combines an analytical method and a Monte Carlo simulation in the relative measurement accuracy analysis. The method is proved to be feasible and credible for the performance analysis of a TGMT based on an aided INS for specific railway track irregularity measurement applications. There is an advantage of employing the semianalytical method over the full simulation approach. Because the error state space KF model for the aided INS is simplified and reduced to a linear timeinvariant stochastic system driven by the input white Gaussian noise for the specific application, it is possible to perform the accuracy analysis beforehand without a raw IMU data generator simulation and an integrated data processing. Thus, the semianalytical method is more computationally efficient than the full simulation approach and more convenient to evaluate the effects of any changes in sensor hardware or error sources on the final measurement accuracy. It aids the system design of a TGMT based on an aided INS without actually building the system, implementing an IMU raw data simulator, and aided INS data processing software. A limitation of this approach is the analytic portion is appropriate only for the situation that the vehicle motion is extremely simple, e.g., railway track geometry surveying. It is not a general method suitable for any ground vehicle systems.
Effect of the inertial sensor errors on the measurement accuracy
With the semianalytical approach, it is convenient to analyze the performance of a TGMT based on GNSS/INS integration and evaluate the effects of any changes in sensor hardware and error sources on the final measurement accuracy, which is very important for sensor selection in the TGMT design procedure. Here, we present a quantitative analysis of the effects of predominant inertial sensor errors, including bias instability and measurement noise of the gyroscopes and accelerometers, on the track irregularity measurement accuracy. The bias is modeled as a firstorder Gauss–Markov process characterized by the correlation time and mean squared value.
Figure 8 shows measurement errors of the STI and LTI in both vertical and alignment directions versus the inertial sensor bias and random noise. It shows a significant increase in measurement errors with respect to the gyroscope bias and noise, i.e., ARW, in both the STI and LTI measurement. While there are no noticeable effects of the accelerometer bias and VRW on the measurement accuracy. The determined track position and track irregularity are highly correlated with the relative measurement accuracy of the attitude angles, including roll, pitch and heading angles. Since the TGMT motion is constrained by rails, the short term attitude accuracy of the GNSS/INS integrated system is dominated by the gyroscope triads.
This figure shows that we can evaluate the system performance with the derived error propagation model and given sensor error sources. We can conclude from the above analysis that the errors in the gyroscopic measurements are the predominant error sources for the TGMT based on GNSS/INS integration. Accelerometer errors seem to have insignificant effects on the system performance and the relative measurement accuracy. However, the accelerometer bias can give rise to roll angle measurements and finally affect the crosslevel measurement. Namely, gyroscopes are critical sensors that determine the performance of the railway track irregularity measurement system. Therefore, in the system design attention should be paid to the gyroscope selection. The above result has answered question 2 raised in the introduction section.
Conclusions
In this research, the temporal and spatial relative measurement accuracy and corresponding error propagation of the GNSS/INS integration specifically for the measurement of railway track irregularities are studied. A semianalytical method is proposed to analyze the relative measurement error propagation model. In the railway surveying, the complexity of the nonlinearity of the aided INS is reduced, allowing each channel to be analyzed separately. Considering the steadystate KF operation, true errors in the optimal estimates of an aided INS are obtained with an analytical expression in the Laplace domain. Based on the derived error propagation model, the relative measurement accuracy of a railway track geometry surveying system based on the aided INS is assessed. The proposed error model is verified by a simulation, which shows the agreement between the results with the semianalytic and simulation method is better than 85% and 93% for the vertical and horizontal channels, respectively.
Therefore, this research has answered the two fundamental questions for a TGMT based on an aided INS: 1) an accuracy of 1 mm is possible in measuring the alignment and vertical track irregularities and 2) the influence of the principal inertial sensor errors on the final measurement accuracy can be quantitatively analyzed. These conclusions are valuable for the development of a TGMT and other inertial surveying applications using an aided INS and can benefit the future research.
Availability of data and materials
The datasets are available from the corresponding author.
References
Benson, D. O. (1975). A comparison of two approaches to pureinertial and Dopplerinertial error analysis. IEEE Transactions on Aerospace and Electronic Systems, 4, 447–455.
Brown, R. G., & Hwang, P. Y. C. (2012). Introduction to Random Signals and Applied Kalman Filtering: with MATLAB Exercises (4th ed.). New York: Wiley.
Chen, Q., Zhang, Q., & Niu, X. (2020). Estimate the pitch and heading mounting angles of the IMU for land vehicular GNSS/INS integrated system. IEEE Transactions on Intelligent Transportation Systems
Chen, Q., Niu, X., Zhang, Q., & Cheng, Y. (2015). Railway track irregularity measuring by GNSS/INS integration. Navigation: Journal of The Institute of Navigation, 62(1), 83–93.
Chen, Q., Niu, X., Zuo, L., Zhang, T., Xiao, F., Liu, Y., & Liu, J. (2018). A railway track geometry measuring trolley system based on aided INS. Sensors, 18(2), 538.
ElSheimy, N., & Youssef, A. (2020). Inertial sensors technologies for navigation applications: State of the art and future trends. Satellite Navigation, 1(1), 1–21.
Groves, P. D. (2008). Principles of GNSS, inertial, and multisensor integrated navigation systems. Boston: Artech House.
Liu, J., Gao, K., Guo, W., Cui, J., & Guo, C. (2020). Role, path, and vision of “5G+ BDS/GNSS.” Satellite Navigation, 1(1), 1–8.
Maybeck, P. S. (1978). Performance analysis of a particularly simple Kalman filter. Journal of Guidance and Control, 1(6), 391–396.
Maybeck, P. S. (1982). Stochastic Models, Estimation, and Control (Vol. I). New York: Academic press.
Niu, X., Chen, Q., Zhang, Q., Zhang, H., Niu, J., Chen, K., et al. (2014). Using Allan variance to analyze the error characteristics of GNSS positioning. GPS Solutions, 18(2), 231–242.
Niu, X., Chen, Q., Kuang, J., & Liu, J. (2016). Return of inertial surveying–trend or illusion? Proceedings of IEEE/ION PLANS, 2016, 165–169.
Shin, E.H. (2005). Estimation techniques for lowcost inertial navigation. Ph.D. thesis, University of Calgary, Deparment of Geomatics Engineering
Teunissen, P., & Montenbruck, O. (2017). Springer Handbook of Global Navigation Satellite Systems. Switzerland: Springer.
Titterton, D., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Stevenage: IET.
Zhang, Q., Niu, X., & Shi, C. (2020). Impact assessment of various IMU error sources on the relative accuracy of the GNSS/INS systems. IEEE Sensors Journal, 20(9), 5026–5038.
Zhang, Q., Niu, X., Chen, Q., Zhang, H., & Shi, C. (2013). Using Allan variance to evaluate the relative accuracy on different time scales of GNSS/INS systems. Measurement Science and Technology, 24(8), 085006.
Zhang, T., Ban, Y., Niu, X., Guo, W., & Liu, J. (2017). Improving the design of MEMS INSaided PLLs for GNSS carrier phase measurement under high dynamics. Micromachines, 8(5), 135.
Zhu, F., Zhou, W., Zhang, Y., Duan, R., Lv, X., & Zhang, X. (2019). Attitude variometric approach using DGNSS/INS integration to detect deformation in railway track irregularity measuring. Journal of Geodesy, 93(9), 1571–1587.
Acknowledgements
The authors thank Wuhan MAP Space Time Navigation Technology Co., LTD, and Guangzhou Datie Detecting & Surveying, Inc., for their efforts in promoting the TGMT using an aided INS.
Funding
This work is funded by the National Natural Science Foundation of China (41904019).
Author information
Authors and Affiliations
Contributions
Conceptualization: Qijin Chen and Xiaoji Niu; Data analysis: Qijin Chen; Writing: Qijin Chen; All authors read and approved the final manuscript.
Corresponding author
Ethics declarations
Competing interests
The authors declare that they have no competing interests.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Appendix
Appendix
Railway track irregularity parameters
For a given railway track section, we can draw a chord of certain length with its start and end points on the rail, as depicted in Fig. 9. Then, the nominal offset from the rail to the chord at mileage s, denoted by \(\text {v}_\text {nom}(s)\), can be computed from the designed geometry of the track. For example, in the straightline section, the nominal versine is zero. Actual rails do not perfectly follow the designed positions and tend to drift away from the nominal smoothness. The offset from the actual rail to the chord is called the actual versine and denoted by \(\text {v}_\text {real}(s)\), which is measured by the classic geodetic instruments or a GNSS/INS integrated system. The difference between the real and nominal versines is defined as
where \(\Delta \text {v}(s)\) can be regarded as the versine offset from the nominal value. Then, the railway track alignment irregularity parameter is computed as
It is clear from the above equation that track alignment irregularity is a relative quantity. A series of Ir, i.e., the pointtopoint variation of the versine deviations, portrays the track’s smoothness. In the standards on precise railway track measurement, the chord length and \(\Delta s\) are defined. The chord length can be chosen as 30 m or 300 m, and the corresponding \(\Delta s\) can then be set as 5 m or 150 m, respectively. The railway track irregularity parameters related to a 30 m chord are called short wavelength irregularities, and those related to a 300 m chord are called long wavelength irregularities. The railway track irregularities are evaluated separately in both horizontal and vertical directions, with the former called alignment and the latter called longitudinal or vertical irregularity. The vertical irregularity parameters are computed using the same method depicted in Fig. 9 but plotted in the mileageheight plane. More details on the track geometric parameters can be found in our previous work (Chen et al. , 2015; Chen et al. , 2018).
Relative measurement accuracy
The navigation error process in an aided INS’s solutions is stochastic. Let \(\Omega\) be a fundamental sample space and T be a subset of the real line denoting a time set of interest. Then, the navigation error process can be defined as a realvalued function of two arguments \(\varvec{e}(t,\omega )\), where the first argument is an element of T and the second an element of \(\Omega\). For any fixed \(t\in T\), \(\varvec{e}(t,\cdot )\) is a random variable. If we fix the second argument, for each point \(\omega _i \in \Omega\) there is associated with a time function \(\varvec{e}(\cdot , \omega _i)\), whose value at each time instant is a sample from the stochastic process.
It is common practice to describe the stochastic navigation error by the associated first two moments, i.e., the mean value function and covariance matrix. The mean value function \(\varvec{m}_e(t)\) and covariance matrix \({\mathbf {P}}_{e}(\cdot )\) of the process \(\varvec{e}(\cdot )\) are defined for all \(t\in T\) by
In the preceding section, we notice that it is the error variation between the navigation error \(\varvec{e}\) at any time instant t and \(t+\Delta t\) that inherently determines the track irregularity measurement accuracy. Here, we denote the relative navigation error for all \(t\in T\) by
The corresponding mean value function and covariance matrix are defined as
Obviously, the information in (A.7), which characterize the TGMT’s relative measurement accuracy, is not available in (A.4).
Analytic analysis of a steadystate Kalman filter estimator
The steadystate KF can be derived from the temporal continuous KF. If the system dynamic matrix \({\mathbf {F}}\), the noise input mapping matrix \({\mathbf {G}}\) in (2), and the measurement matrix \({\mathbf {H}}\) are all constant matrices, and if the system noise and measurement noise are stationary (\({\mathbf {Q}}\) and \({\mathbf {R}}\) are constant), the KF for a GNSS/INS/NHC integrated system may reach steadystate performance, leading to a constant covariance matrix \({\mathbf {P}}\). In this condition, the Riccati equation for the continuous KF becomes an algebraic relation:
In the steadystate condition, the rate at which the uncertainty increases (given by \({\mathbf {G}}{\mathbf {Q}}{\mathbf {G}}^\text {T}\)) is balanced by the rate at which new information enters (\({\mathbf {P}}{\mathbf {H}}^\text {T}{\mathbf {R}}^\text {1}{\mathbf {H}}{\mathbf {P}}\)) and the dissipative effects of the system (\({\mathbf {F}}{\mathbf {P}} + {\mathbf {P}}{\mathbf {F}}^\text {T}\)). For a steadystate covariance matrix, the optimal filter is also time invariant, given by
Taking the Laplace transform of this (neglecting initial conditions) yields
so that
\(\hat{\varvec{x}}(s)\) is the optimal estimate of the state vector of the KF for the GNSS/INS/NHC integration. The term in brackets in the above equation is the transfer function representation of the steadystate KF. More details about the steady state can be found in the textbook [(Maybeck , 1982), p. 273].
Navigation error propagation of the aided INS in the horizontal channel
The navigation error propagation analysis in the horizontal channel is similar to that for the vertical channel. According to assumption 1, the host vehicle is assumed to move at constant speed in a northward straight line. The north channel is the alongtrack direction, for which centimeterlevel accuracy is sufficient and easy to fulfill when an accurate GNSS position is available. The east position component of the aided INS determines the track alignment measurement accuracy in the acrosstrack direction, which is critical for railway track geometry surveying (Chen et al. , 2015). Therefore, for the horizontal channel, we concentrate only on the east direction.
In addition to the position and velocity errors, the tilt error \(\phi _N\) is augmented into the error state vector, since a tilt error will introduce an acceleration component due to gravity with magnitude \(g\phi _N\) to be projected onto the horizontal axes (Titterton and Weston , 2004)). The attitude error about the yaw axis is also considered once the NHC is used. In this case the residual gyro bias about the xaxis \(\delta b_{gN}\) and about the zaxis \(b_{gD}\), as well as the east component of the accelerometer bias \(\delta b_{aE}\), should also be augmented into the error state vector of the filter. Then there are seven error state variables:
The state dynamics model can be written as
with
where the subscript ‘E’ denotes the east direction. \(\varvec{w}_E\) represents the driving zeromean white Gaussian noise of strength \({\mathbf {Q}}_E(t)\)
where \({\mathbf {I}}_6\) is the 6by6 identity matrix. \(\delta b_{gN}\) is the north component of the gyro bias, modeled as a firstorder Gauss–Markov process with correlation time \(T_{gb}\) and driven by zeromean white Gaussian noise \(w_{gbN}\); \(\delta b_{gD}\) is the vertical component of the gyro bias, modeled as a firstorder Gauss–Markov process with correlation time \(T_{gb}\) and driven by zeromean white Gaussian noise \(w_{gbD}\). \(b_{aE}\) is the east component of the accelerometer bias, modeled as a firstorder Gauss–Markov process with correlation time \(T_{ab}\) and driven by zeromean white Gaussian noise \(w_{abE}\). \(w_{aE}\) represents the accelerometer measurement noise along the east axis. \(w_{gN}\) and \(w_{gD}\) are the north and vertical components of the gyro measurement noise, respectively.
The measurement to be presented to the KF for the aided INS in the east direction should include the position difference between the INS and GNSS and the crosstrack velocity difference between the INS and the NHC. Considering assumption 1, we have \(v_D = 0\). Then, the velocity measurement Eq. (25) can be simplified as
where \(n_{vE}\) is the east component of \(\varvec{n}_{v}\) in (12) and represents the measurement uncertainty of the acrosstrack zero velocity. The GNSS position measurement equation can then be written as
Therefore, the measurement equations for the aided INS in the east direction can be written as
where \(\varvec{z}_E = \left[ \begin{matrix} z_{r,E}&z_{vnhc,E}\end{matrix}\right] ^\text {T}\), \(\varvec{n}_E = \left[ \begin{matrix} n_{r,E}&n_{vnhc,E}\end{matrix}\right] ^\text {T}\)
It is obvious from (B.3), (B.4) and (B.10) that \({\mathbf {F}}_E\), \({\mathbf {G}}_E\), \({\mathbf {H}}_E\), \({\mathbf {R}}_E\) and \({\mathbf {Q}}_E\) are all constant matrices. The introduction of the NHC makes the heading error observable; thus, the filter gains will converge to steadystate values. In this situation \({\mathbf {P}}\) and \({\mathbf {K}}\) also become constant matrices. The gain matrix \({\mathbf {K}}\) in this case is a 7by2 matrix. A similar derivation can be performed for the vertical channel to obtain the east position component error propagation model as
where \(H_{aE}\), \(H_{gN}\), \(H_{gD}\), \(H_{gbN}\), \(H_{gbD}\), \(H_{abE}\), \(H_{vE}\), and \(H_{rE}\) represent the related coefficients of the noise terms. The above equation is the east position error propagation model of the aided INS in the Laplace domain.
Rights and permissions
Open Access This article is licensed under a Creative Commons Attribution 4.0 International License, which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons licence, and indicate if changes were made. The images or other third party material in this article are included in the article's Creative Commons licence, unless indicated otherwise in a credit line to the material. If material is not included in the article's Creative Commons licence and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder. To view a copy of this licence, visit http://creativecommons.org/licenses/by/4.0/.
About this article
Cite this article
Chen, Q., Zhang, Q., Niu, X. et al. Semianalytical assessment of the relative accuracy of the GNSS/INS in railway track irregularity measurements. Satell Navig 2, 25 (2021). https://doi.org/10.1186/s43020021000579
Received:
Accepted:
Published:
DOI: https://doi.org/10.1186/s43020021000579