Next Article in Journal
Optimizing Routing Protocol Design for Long-Range Distributed Multi-Hop Networks
Previous Article in Journal
Using Social Robotics to Identify Educational Behavior: A Survey
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Innovation Adaptive UKF Train Location Method Based on Kinematic Constraints

School of Automation and Electrical Engineering, Lanzhou Jiaotong University, Lanzhou 730070, China
*
Author to whom correspondence should be addressed.
Electronics 2024, 13(19), 3958; https://doi.org/10.3390/electronics13193958
Submission received: 7 September 2024 / Revised: 4 October 2024 / Accepted: 5 October 2024 / Published: 8 October 2024

Abstract

:
To address the issue of reduced positioning accuracy caused by satellite signal interruptions when trains pass through long tunnels, a novel train positioning method based on an innovative adaptive unscented Kalman filter (UKF) under kinematic constraints is proposed. This method aims to improve the accuracy of the location of trains during operation. By considering the dynamic characteristics of the train, a dynamic kinematic-constrained inertial navigation system (INS)/odometer (ODO) combination positioning system is established. This system utilizes kinematic constraints to correct the accumulated errors of the INS. Additionally, the algorithm incorporates real-time estimation of the measurement noise covariance using innovation sequences. The updated adaptive estimation algorithm is applied within the UKF framework for nonlinear filtering, forming the innovative adaptive UKF algorithm. At each time step, the difference between the ODO sensor data and the INS output is used as the measurement input for the innovative adaptive UKF algorithm, enabling global estimation. This process ultimately yields the actual positioning result for the train. Simulation results demonstrate that the innovative adaptive UKF train positioning method, incorporating kinematic constraints, effectively mitigates the impact of satellite signal interruptions. Compared with the traditional INS/ODO positioning method, the innovative adaptive UKF method reduces position errors by 34.35% and speed errors by 36.33%. Overall, this method enhances navigation accuracy, minimizes train positioning errors, and meets the requirements of modern train positioning systems.

1. Introduction

Train positioning technology is crucial for enhancing traffic safety and optimizing transportation efficiency. Currently, train positioning primarily depends on trackside equipment, which no longer meets the demands of the new generation of train control systems [1]. Advancements in high-speed rail signaling technology have driven the development of multi-sensor combination positioning methods, addressing the limitations of single-sensor systems and opening new possibilities for achieving high-precision train positioning [2,3].
In the field of land mobile navigation, sensor fusion technologies have been widely adopted, particularly in automobiles and autonomous aerial vehicles. Liu et al. employed an integrated global navigation satellite system (GNSS)/inertial navigation system (INS) in autonomous vehicles to update the measurement noise variance in real-time and introduce attenuation factors that increase the weight of the current measurement. This effectively suppresses white noise and mitigates environmental interference, leading to more accurate vehicle navigation [4,5]. Zhang et al. proposed an adaptive Kalman filtering method to address the issue of weak GNSS signals in the GNSS/INS integrated navigation system for unmanned aerial vehicles (UAVs) [6]. This method dynamically adjusts the GNSS measurement noise covariance using an accuracy classification model trained via supervised machine learning, effectively addressing the localization issue for UAVs when GNSS signals are disturbed. This approach provides a promising pathway for solving the challenge of determining the precise location of trains. The complex and dynamic operating environments of trains make it difficult to achieve accurate positioning based solely on satellite signals [7,8]. As a result, achieving precise train positioning often necessitates the integration of additional sensors into a multi-sensor fusion positioning system [9,10]. Numerous scholars have extensively researched train positioning through sensor fusion and its associated risk assessment technologies using GNSS [11,12,13,14]. However, challenges emerge when trains pass through tunnels, where GNSS signals are weak or interrupted. In these situations, the lack of GNSS corrections amplifies INS errors, leading to substantial drift and severely affecting the accuracy of the multi-sensor fusion positioning system [15]. Currently, there are two primary solutions to mitigate the rapid divergence of INS errors following satellite signal interference or interruption. One approach is to integrate additional sensors to improve train positioning accuracy [16,17]. To enhance positioning accuracy, Li et al. integrated a framework combining a strapdown inertial navigation system (SINS), odometer (ODO), and laser Doppler velocimetry. Additionally, they proposed the Schmidt EKF information fusion algorithm, which effectively reduces positioning errors [18]. In onboard railway positioning systems, some scholars combine SINS, ODO, and digital track maps. Track features are extracted during the offline stage and stored in the map to improve positioning accuracy [19,20]. During train operation, these stored track features are detected and matched to correct ODO errors, thereby improving positioning accuracy [21].
The second approach involves utilizing track or train dynamic kinematic constraints to mitigate INS drift errors and achieve precise train positioning in tunnels [22]. By integrating GNSS and INS with motion constraints and considering the dynamic characteristics of track geometry measurement vehicles, navigation accuracy is improved. Liu et al. developed a high-precision laser integrated with the INS/GNSS positioning method, which significantly enhances system accuracy during GNSS signal interruptions by leveraging motion constraints [15]. Zhu et al. introduced the application of installation angle adjustments to improve the motion constraint model, integrating the motion characteristics of trains with inertial measurement unit (IMU) and ODO sensors. This model uses the GNSS system to estimate the installation angle of the IMU under favorable GNSS signal conditions [23]. By combining ODO data with dynamic kinematic constraints, inertial navigation errors are minimized, enhancing navigation accuracy in tunnels. Zhang et al., considering cost-effectiveness and practicality, employed train kinematic constraints to effectively reduce accumulated errors during INS operation, thereby improving train positioning accuracy [24]. Zhou et al. evaluated the spatial relative accuracy for measuring shortwave trajectory irregularities. This evaluation used specific indicators and calculations to assess relative accuracy, aiming to establish an accuracy threshold that meets the measurement constraints [25].
The multi-sensor information fusion algorithm is the core of combinational positioning and is crucial for ensuring system performance. Two widely used methods are the extended Kalman filter (EKF) and unscented Kalman filter (UKF) [26]. Based on the Kalman filter, the extended Kalman filter (EKF) addresses nonlinear system problems through linearization techniques. At each iteration, the EKF approximates the nonlinear state transition and observation models using a first-order Taylor series expansion around the current estimate, achieving local linearization. The recursive Kalman filter equations are then applied to this linearized model to predict and update the state, providing optimal estimation of the system state and its uncertainty [27]. The UKF algorithm utilizes calculated sigma points to perform the Unscented Transformation (UT), approximating the posterior probability density function of the system state [28]. Compared to the EKF algorithm, the UKF offers advantages such as simpler estimation of the posterior mean and variance of the state vector, better convergence performance, and significantly improved filtering accuracy when handling nonlinear systems [29]. An algorithm combining support vector regression (SVR) and adaptive UKF is proposed to predict and handle abnormal measurements using SVR. It adjusts the measurement noise covariance matrix in real-time, enhancing the robustness and accuracy of the UKF in environments with outliers [30]. Based on the covariance matching principle, Meng et al. designed an adaptive UKF capable of estimating the system’s noise variance online [31]. Lin et al. combined particle filtering with the UKF to propose an enhanced hybrid filtering method, enabling accurate estimation in highly nonlinear systems [32]. The performance advantage can be optimized by flexibly adjusting the distribution of sigma points and the number of particles to meet the requirements of different complexity levels in application scenarios. Gu et al. proposed an improved adaptive UKF algorithm that dynamically estimates and corrects the statistical characteristics of system noise in real-time. Additionally, an adaptive fading factor mechanism is introduced to effectively enhance the estimation accuracy and operational reliability of the system [33]. Hu et al. proposed a robust UKF algorithm based on the innovation orthogonality principle, designing a single measurement fault scale factor to implement a unified adjustment strategy for the measurement noise covariance matrix when handling system failures [34]. The results of simulation experiments fully demonstrate that the filtering algorithm is highly robust and effective when confronted with significant deviations in sensor measurements. Li et al. proposed an adaptive federated filtering method by introducing adaptive filter factors to develop information allocation strategies within federated filters [35]. In the application of this method, the precision single-point positioning system, assisted by an INS, provides a more accurate initial value estimation, thereby improving the overall performance of the positioning system. However, differences in sampling frequencies and error characteristics among various sensors can affect the timeliness of information fusion, which can, in turn, reduce positioning accuracy. Recent studies show that current train positioning methods primarily rely on multi-sensor fusion techniques, integrating GNSS with other sensors to enhance accuracy through algorithmic improvements. As railway infrastructures, such as the Sichuan-Tibet Railway, become more complex—with extensive mountainous terrain and numerous long tunnels—interruptions in satellite signals within these tunnels significantly degrade positioning accuracy.
To address these challenges, this paper proposes an innovative adaptive UKF-based train positioning method that integrates kinematic constraints. By leveraging the dynamic characteristics of train operations, a kinematically constrained INS/ODO positioning system is developed. This system employs dynamic kinematic constraints to correct the accumulated errors in INS data. At the same time, real-time estimation of measurement noise covariance is combined with innovative sequences, improving the adaptive estimation algorithm within the UKF framework for nonlinear filtering. This results in the development of an advanced adaptive UKF algorithm. In the proposed method, the difference between the outputs of the ODO sensor and INS serves as the measurement data, which is vital for the adaptive UKF algorithm to achieve precise global estimation and provide accurate train positioning results.

2. INS/ODO Train Combination Positioning System

2.1. Structure of Train Combination Positioning System

The train positioning system discussed in this article primarily integrates data from an INS and an ODO. By combining these sensor inputs, the system performs data collection, preprocessing, fusion, transmission, and display of position information. This process enables real-time monitoring of the train’s dynamics and ensures accurate positioning. Figure 1 illustrates the INS/ODO combined train positioning system, highlighting its integration with dynamic kinematic constraints.
The kinematically constrained INS/ODO train positioning system employs kinematic constraints to mitigate the accumulated errors inherent in the INS. It integrates the differential data between ODO velocity measurements and INS outputs as part of the measurement inputs for an innovative adaptive UKF algorithm. This approach estimates global errors and corrects INS deviations by incorporating feedback related to zero bias and specific force factors. Additionally, refined gyroscope and accelerometer data from the INS are used to enhance updates on train angular velocity, acceleration, and system error estimates. These components work synergistically to provide a cohesive and accurate navigation solution for the train.

2.2. Train Combination Positioning System Model

The mathematical model of the INS/ODO combined train positioning system consists of two components: the state model and the measurement model.

2.2.1. The State Model of the System

The system state variables are categorized into two distinct types: INS errors and ODO errors. The state vector of the system is expressed as follows:
x = δ v E , δ v N , δ v U , ε X , ε Y , ε Z , δ f x , δ f y , δ f z , δ ψ , δ K D , δ θ T
Among these, ( δ v E , δ v N , δ v U ) represent the velocity errors of the train in the east, north, and vertical directions; ( ε X , ε Y , ε Z ) and ( δ f x , δ f y , δ f z ) are the gyroscope and acceleration errors of the INS; and ( δ ψ , δ K D , δ θ ) represent the ODO errors.
By combining the state equations of the INS and ODO, it can be simplified as follows:
x ˙ ( t ) = F ( x ( t ) , t ) + G ( t ) w ( t )
where δ x ˙ denotes the differential of the system error state vector; δ x denotes the system error state vector; F ( · ) denotes a nonlinear state transition function; G ( t ) denotes the noise array; and w ( t ) denotes the process noise of the system.

2.2.2. System Measurement Model

In the integrated positioning system, the velocity outputs from the INS and ODO are compared by subtracting them to derive the difference, serving as the measurement information for the positioning system. The true value and error of the INS velocity can be expressed as follows:
v ˜ n = v n + δ v n
where v ˜ n denotes the carrier velocity calculated by INS, v n denotes the true value of the train carrier velocity, and δ v n denotes the velocity error. Then, we subtract the carrier velocity v ˜ D n calculated by the ODO from v ˜ n ; It can be obtained as follows:
Δ v = v ˜ n v ˜ D n = v n + δ v n v n + φ × v n C b n v ˜ D b = δ v n φ × v n C b n v ˜ D b
Among these, φ denotes the attitude error vector; and C b n denotes a  3 × 3 transformation matrix. The velocity error Δ v can be represented along the three axes of the navigation coordinate system as follows:
Δ v = Δ v E n Δ v N n Δ v U n
Then, the obtained measurement error is as follows:
Δ v = δ v E n δ v N n δ v U n 0 v U n v N n v U n 0 v E n v N n v E n 0 φ E , φ N , φ U T C b n v D δ ψ , δ K D , δ θ T
Among these, ( φ E , φ N , φ U ) represent the attitude error information of the train in the east, north, and vertical directions. The measurements in the INS/ODO cooperative navigation system include pseudorange, differential pseudorange, and relative distance measurements. Relative distance measurements are obtained by calculating the difference between the INS equivalent relative distance and the ODO distance measurement. The measurement equation for the INS/ODO combined positioning system is expressed as follows:
z ( t ) = H ( x ( t ) , t ) + V ( t )
where z ( t ) represents the measurement vector, V ( t ) represents the noise matrix, and H ( · ) represents a nonlinear measurement function.

2.3. Dynamic Kinematic Constraints of Trains

In traditional combined positioning solutions, it is generally assumed that the lateral and vertical motions of the train—specifically, the velocities along the lateral (Y-axis) and vertical (Z-axis) axes of the car body—are negligible. This assumption is based on the premise that the train remains stable on its tracks. As a result, dynamic kinematic constraints suggest that velocities along both the Y-axis and Z-axis in the car body coordinate system are consistently zero. This simplification leverages the physical characteristics of trains to improve model accuracy. However, prior methodologies often set a fixed variance for these dynamic kinematic constraints—commonly around 0.1 m/s or 0.2 m/s [24]—which may not adequately reflect the actual movements of the train in complex environments. Track curvature, in particular, can significantly influence both the train’s attitude and displacement during turns and gradient transitions. By incorporating track curvature constraints, the angular velocity, acceleration, and displacement estimates derived from INS can be corrected to reduce attitude errors. Track geometry often exhibits non-linear characteristics, especially at complex intersections or sharp curves. Using a UKF algorithm allows the integration of these non-linear constraints into the state estimation process, ultimately enhancing the accuracy of the overall system.
To further enhance the precision of the solution, this paper proposes a method for dynamically adjusting kinematic constraint variances based on INS outputs. Specifically, train motion stability is evaluated by calculating the noise variance from INS output data over one-second intervals. When the calculated noise variance falls below a predetermined threshold, it indicates relative stability in the train’s movement. This allows for dynamic adjustment of the kinematic constraint variances according to the noise levels from the INS sensors. This approach enables greater “trust” in dynamic kinematic constraints during steady states, where stricter variances can be applied to improve positional accuracy. Conversely, under unstable conditions, where confidence in these constraints diminishes, increased variances prevent erroneous results caused by overly restrictive limitations. By adaptively adjusting the kinematic constraint variances, the integrated INS/ODO positioning system can respond more flexibly to varying operational conditions. It applies stringent kinematic parameters when the train is in a stable state while adjusting variances based on noise levels during periods of dynamic changes. This assumption implies that the train’s velocities along the y-axis and z-axis are both zero within the coordinate system. The specific process can be described as follows:
δ v y 0 b = 0 δ v z 0 b = 0
Among these, δ v y 0 b and δ v z 0 b represent the train’s velocity in the coordinate system’s y direction and z direction, respectively.
Assuming that the train is traveling at a constant velocity at a given moment, we can infer the velocity of the train in the direction of travel as follows:
v x b ( k + 1 ) = v x b ( k )
Here, v x b ( k ) can be obtained through the output data of INS and ODO sensors, as follows:
v x b ( k ) = v I / D b x 2 + v I / D b y 2 + v I / D b z 2
Among these, v I / D b x , v I / D b y , and v I / D b z denote the train velocities in the coordinate system; we can obtain the following:
v I / D b = C n b v I / D n
Therefore, the error measurement of train velocity under dynamic kinematic constraints is as follows:
z v ( t ) = C b v C n b v x b ( t ) + n v ( t )
The above equation represents the measurement model of the UKF algorithm, where n v represents the noise matrix of the dynamic kinematics constraint, which is calculated as follows:
n v = v x s t d 0 0 v y s t d
where v x s t d , v y s t d represent the variance of the accelerometer on the X and Y axes within 1 s, respectively.

3. Innovative Adaptive UKF Information Fusion Algorithm

Compared to the EKF and particle filter (PF), the UKF offers significant advantages in the INS/ODO combined positioning system for trains. These advantages are mainly reflected in UKF’s ability to handle nonlinear problems, higher computational efficiency, and robustness in high-noise environments [28]. UKF avoids errors caused by linearization through unscented transformation, allowing it to better capture the system’s nonlinear dynamics. Additionally, UKF does not require the computation of a Jacobian matrix, simplifying its implementation and enabling it to handle the complex track and environmental changes more effectively. In contrast, EKF is constrained by the limitations of the linearization process, while PF, despite its theoretical capability to handle nonlinearities, suffers from high computational complexity, making it less suitable for real-time applications [29]. As a result, UKF is well-suited for such positioning systems. To mitigate the accumulation of errors in INS calculations, dynamic kinematic constraints are applied based on the train’s operational characteristics. These constraints help compensate for errors by aligning the calculations with the actual motion dynamics of the train. At the same time, the difference between the ODO sensor and INS output data serves as the measurement input for the innovative adaptive UKF algorithm, which performs global state estimation to determine the train’s position at the current moment. Subsequently, the innovative adaptive UKF algorithm is used to predict the train’s location for the next time step. The final navigation results are then output and fed back into the INS system to correct any errors that have accumulated during the previous calculation cycle. Figure 2 illustrates the process of the INS/ODO train positioning information fusion algorithm, incorporating dynamic kinematic constraints.
As shown in Equation (3), the state equation of the INS/ODO combined positioning model for trains exhibits nonlinear characteristics. To more accurately estimate the system’s state, the UKF algorithm is employed to address the state estimation problem during the information fusion process.
The state model (3) and measurement model (8) of the train’s combined positioning system are discretized and can be expressed as follows:
x k = f ( x k 1 , k 1 ) + G k 1 w k 1 z k = h x k , k + v k
Among these, f ( · ) denotes a nonlinear state transition function; G k 1 denotes the noise array; h ( · ) denotes a nonlinear measurement function; w k 1 denotes the system noise vector, v k denotes the measurement noise vector.
The specific process of the UKF algorithm is as follows [28]:
(i) Calculate the (2n + 1)-th sigma point as follows:
η 0 = x ^ k 1 η i = x ^ k 1 + α n p ^ i e i i = 1 , 2 , , n η i = x ^ k 1 α n p ^ i n e i n i = n + 1 , n + 2 , , 2 n
In the formula, α n p ^ i denotes the i column of the square root of the covariance matrix. α = n + λ , λ = γ 2 ( n + k ) n , γ takes 0∼1, and k = 3 n .
(ii) Time update.
After determining the sigma point sampling, the time update equation can be changed to the following:
x ^ k , k 1 = w i , n η i , k , k 1 P x , k , k 1 = w i , c η i , k , k 1 x ^ k , k 1 × η i , k , k 1 x ^ k , k 1 + Q k
In the formula, η k , k 1 denotes the sigma point from time k 1 to k, x ^ k , k 1 denotes the predicted estimated value of the system state from time k 1 to k, and P k , k 1 denotes the covariance matrix for predicting and estimating this state, quantifying the error range of the predicted estimation values.
(iii) Measurement update.
z ^ k = i = 0 2 n w i , n z i , k , k 1 P z z = i = 0 2 n w i , c z i , k , k 1 z ^ × z i , k , k 1 z ^ T + R k
In the formula, z ^ k , k 1 denotes the predicted measurement value from time k 1 to k, z ^ k denotes the predicted measurement value at time k, and P z z denotes the covariance matrix of z ^ k .
For the nonlinear system of Equation (16), the UKF algorithm is updated with measurements, and the predicted value is as follows:
z ^ k = i = 0 2 n w i η i *
where η i * denotes the i measurement point; the calculation update is as follows:
δ z ^ k = z k i = 0 2 n w i η i * = z k z ^ k + z ^ k i = 0 2 n w i η i * = v k + i = 0 2 n w i z ^ k i = 0 2 n w i η i * = v k + i = 0 2 n w i z ^ k η i *
Real-time estimation of measurement noise variance based on innovation sequences. The innovation sequence is defined as follows:
ε k = z k h k x k , k 1 = h k x k x k , k 1 + v k
When the innovation sequence follows a zero-mean, independently and identically distributed Gaussian white noise model, the innovation covariance matrix is calculated as follows:
S k = E ε k ε k T
Therefore, adaptive factor β k is used to adjust the innovation covariance matrix S k in the Kalman gain, so that the performance of the algorithm can be optimized online.
K k = P z z , k , k 1 β k S k 1 = 1 β k P z z , k , k 1 S k 1
Finally, the measurement equation is updated, and the updated state and covariance estimation are obtained as follows:
x ^ k = x ^ k , k 1 + K k ϵ k
P k = P x , k , k 1 K k S k K k T

4. Verification and Analysis

To evaluate the effectiveness of the innovation adaptive UKF approach in train positioning under dynamic kinematic constraints, a train motion model was developed using MATLAB R2022b software, and a simulation experiment was conducted. Real data from the Longnan to Guangyuan section of the Lanzhou–Chongqing Railway were utilized to simulate the positioning performance of the INS/ODO combined positioning system in a tunnel environment where satellite signals are unavailable. The simulation emulated various stages of train operations in a continuous tunnel group, including acceleration, climbing, turning, deceleration, and waiting to avoid obstacles, with speed variations ranging from 60 to 200 km/h. During the process, both INS and ODO data were recorded. The specific sensor parameters are presented in Table 1. The train operation data from GPST 457250 to 457900 were analyzed over a total duration of 650 s, and a simulated train trajectory was constructed. Satellite signal interruptions were simulated in five segments, with each interruption lasting 60 s. The results showed that the performance of the INS/ODO train positioning system, constrained by the innovative adaptive UKF algorithm and dynamic kinematics, was superior in the absence of satellite signals. To evaluate the effectiveness of the innovative adaptive UKF algorithm, its accuracy was compared to that of the UKF algorithm during simulated satellite signal interruptions, as shown in Table 2.
The longitude -latitude track of the train is shown in Figure 3, where the curve represents the actual railway line in this section. Using high-precision SPAN-FSAS-integrated navigation results as a reference, the errors of both the UKF algorithm and the innovative adaptive UKF algorithm were calculated through epoch-wise differencing. A comparative analysis of the results was then conducted.
Figure 4 illustrates the positional errors of the train in the north, east, and vertical directions, while Figure 5 depicts the velocity errors in the corresponding directions. In both figures, five satellite signal interruptions are highlighted in red. For instance, in Figure 4, these interruptions are labeled as interrupts no. 1 through no. 5.
The comparative analysis of Figure 4 and Figure 5 clearly demonstrates that during satellite signal interruptions, the error associated with the innovative adaptive UKF algorithm is significantly lower than that of the standard UKF algorithm. This highlights the superior performance of the proposed innovative adaptive UKF in information processing and data fusion. The algorithm shows an enhanced ability to integrate multiple data sources, effectively reducing positioning errors in scenarios where satellite signals are unstable or interrupted.
To further compare and analyze the positioning accuracy of the two algorithms, detailed statistics for various error cases were compiled, with the relevant data summarized in Table 3 and Table 4. As shown in these tables, during the five-stage satellite signal interruption, the maximum positional errors in the north, east, and vertical directions under the innovative adaptive UKF algorithm were 3.1 m, 3.9 m, and 7.06 m, respectively. These results outperformed the UKF algorithm, which had maximum errors of 5.6 m, 6.2 m, and 9.32 m in the same direction. Additionally, during the five-stage satellite signal interruption, the maximum velocity errors for the north, east, and vertical directions under the innovative adaptive UKF algorithm were 0.41 m/s, 0.61 m/s, and 0.48 m/s, respectively. These also surpassed the UKF algorithm, which exhibited velocity errors of 0.44 m/s, 0.66 m/s, and 0.56 m/s.
Based on the findings presented above, it can be concluded that during satellite signal interruptions, the proposed innovative adaptive UKF algorithm significantly reduces positioning errors compared to the UKF algorithm. Analyzing data from the five segments with signal interruptions, it is evident that the innovative adaptive UKF algorithm consistently demonstrates smaller velocity, mean position error (Mean), and root mean square error (RMSE) values compared to the UKF algorithm. The innovative adaptive UKF algorithm achieved RMSE reductions of 32.02% in the north direction, 33.14% in the east direction, and 21.74% in the vertical direction. Similarly, velocity errors in the north, east, and vertical directions were reduced by 36.36%, 38.46%, and 14.39%, respectively. These results indicate that during satellite signal interruptions, the innovative adaptive UKF algorithm significantly enhances the global optimization of INS and ODO information, leading to improved train positioning accuracy.
To evaluate the impact of incorporating dynamic kinematic constraints on the accuracy of the INS/ODO train positioning system in tunnel environments, we conducted a comparative simulation analysis of two approaches. These approaches included the standard INS/ODO train combination positioning system and the dynamic kinematic constraint INS/ODO train combination positioning system. In both systems, the innovative adaptive UKF algorithm was used as the information fusion method. The comparative simulation results for these two positioning methods are presented in Figure 6 and Figure 7.
By analyzing the position error comparison data in Figure 6, it is evident that the incorporation of dynamic kinematic constraints significantly improved the positioning accuracy of the INS/ODO train combination positioning system. Specifically, with these constraints, the maximum positioning error was reduced to 6.38 m, and the average error improved by 34.35% compared to the system without dynamic kinematic constraints. Similarly, the velocity error comparison in Figure 7 demonstrates that the velocity error of the system with dynamic kinematic constraints exhibited relatively smooth variations, further indicating enhanced positioning accuracy. Compared to the INS/ODO system without dynamic constraints, the maximum velocity error in the constrained system was reduced to 0.38 m/s, with an average error reduction of 36.33%. These results clearly demonstrate that the innovative adaptive UKF train positioning system, when operating under dynamic kinematic constraints, maintains high navigation accuracy even in environments where satellite signals are unavailable, such as tunnels.

5. Conclusions

To address the challenge of reduced positioning accuracy caused by satellite signal interruptions in tunnels, we developed an integrated INS/ODO train positioning system. Leveraging the train’s motion characteristics, we proposed an innovative adaptive UKF train positioning method that incorporates dynamic kinematic constraints. This method enhances the fusion of data within the INS/ODO system using an innovative adaptive UKF algorithm. Experimental results demonstrated that the innovative adaptive UKF algorithm offers significant improvements in estimating train position errors compared to the UKF algorithm. When applied to the dynamic kinematic constraints INS/ODO train positioning system, the innovative adaptive UKF method achieved a 34.35% reduction in position errors and a 36.33% reduction in velocity errors compared to the system without constraints. This confirms that the proposed approach effectively improves positioning accuracy, particularly in environments such as tunnels, where satellite signals are unavailable. Looking ahead, further optimization of the train positioning method will be required, especially in scenarios like forced or unexpected stops within long tunnels. Enhancing the system with additional sensors and addressing the issue of error divergence in the INS system will be crucial. Techniques such as zero velocity correction and other strategies should be explored to further mitigate error divergence and enhance the reliability of train positioning systems.

Author Contributions

Conceptualization, X.L.; methodology, X.L. and J.Z.; software, J.Z.; validation, X.L.; formal analysis, J.Z.; investigation, X.L. and J.Z.; resources, X.L.; writing—original draft preparation, J.Z.; writing—review and editing, X.L.; visualization, J.Z.; supervision, X.L.; project administration, X.L.; funding acquisition, X.L. All authors have read and agreed to the published version of the manuscript.

Funding

This work was supported in part by a key special project, “Science and Technology Assists Economy 2020”, from the Gansu Provincial Department of Science and Technology (no. SQ2020YFF0403641).

Data Availability Statement

The data that support the findings of this study are available from the author upon reasonable request.

Conflicts of Interest

The authors declare no conflicts of interest.

References

  1. Rahimi, M.; Liu, H.; Cardenas, I.D.; Starr, A.; Hall, A.; Anderson, R. A review on technologies for localisation and navigation in autonomous railway maintenance systems. Sensors 2022, 22, 4185. [Google Scholar] [CrossRef] [PubMed]
  2. Otegui, J.; Bahillo, A.; Lopetegi, I.; Díez, L.E. A survey of train positioning solutions. IEEE Sens. J. 2017, 17, 6788–6797. [Google Scholar] [CrossRef]
  3. Hamid, H.A.; Nicholson, G.L.; Roberts, C. Impact of train positioning inaccuracies on railway traffic management systems: Framework development and impacts on TMS functions. IET Intell. Transp. Syst. 2020, 14, 534–544. [Google Scholar] [CrossRef]
  4. Liu, Y.; Fan, X.; Lv, C.; Wu, J.; Li, L.; Ding, D. An innovative information fusion method with adaptive Kalman filter for integrated INS/GPS navigation of autonomous vehicles. Mech. Syst. Signal Process. 2018, 100, 605–616. [Google Scholar] [CrossRef]
  5. Cong, L.; Yue, S.; Qin, H.; Li, B.; Yao, J. Implementation of a MEMS-based GNSS/INS integrated scheme using supported vector machine for land vehicle navigation. IEEE Sens. J. 2020, 20, 14423–14435. [Google Scholar] [CrossRef]
  6. Zhang, G.; Hsu, L.T. Intelligent GNSS/INS integrated navigation system for a commercial UAV flight control system. Aerosp. Sci. Technol. 2018, 80, 368–380. [Google Scholar] [CrossRef]
  7. Gao, Y.; Liu, Z.; Wang, Y.; Noureldin, A. A hybrid RISS/GNSS method during GNSS outage in the land vehicle navigation system. IEEE Sens. J. 2023, 23, 8690–8702. [Google Scholar] [CrossRef]
  8. Guo, X.; Ansari, N.; Hu, F.; Shao, Y.; Elikplim, N.R.; Li, L. A survey on fusion-based indoor positioning. IEEE Commun. Surv. Tutor. 2019, 22, 566–594. [Google Scholar] [CrossRef]
  9. Jiang, C.; Zhang, S.; Li, H.; Li, Z. Performance evaluation of the filters with adaptive factor and fading factor for GNSS/INS integrated systems. GPS Solut. 2021, 25, 130. [Google Scholar] [CrossRef]
  10. Jiang, W.; Liu, M.; Cai, B.; Rizos, C.; Wang, J. An accurate train positioning method using tightly-coupled GPS+ BDS PPP/IMU strategy. GPS Solut. 2022, 26, 67. [Google Scholar] [CrossRef]
  11. Zhu, F.; Zhou, W.; Zhang, Y.; Duan, R.; Lv, X.; Zhang, X. Attitude variometric approach using DGNSS/INS integration to detect deformation in railway track irregularity measuring. J. Geod. 2019, 93, 1571–1587. [Google Scholar] [CrossRef]
  12. Specht, M.; Specht, C.; Dąbrowski, P.; Czaplewski, K.; Smolarek, L.; Lewicka, O. Road tests of the positioning accuracy of INS/GNSS systems based on MEMS technology for navigating railway vehicles. Energies 2020, 13, 4463. [Google Scholar] [CrossRef]
  13. Li, X.; Wang, H.; Li, S.; Feng, S.; Wang, X.; Liao, J. GIL: A tightly coupled GNSS PPP/INS/LiDAR method for precise vehicle navigation. Satell. Navig. 2021, 2, 26. [Google Scholar] [CrossRef]
  14. Shan, T.; Englot, B.; Ratti, C.; Rus, D. Lvi-sam: Tightly-coupled lidar-visual-inertial odometry via smoothing and mapping. In Proceedings of the 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi’an, China, 30 May–5 June 2021; pp. 5692–5698. [Google Scholar]
  15. Liu, D.; Jiang, W.; Cai, B.; Heirich, O.; Wang, J.; Shangguan, W. Robust train localisation method based on advanced map matching measurement-augmented tightly-coupled GNSS/INS with error-state UKF. J. Navig. 2023, 76, 316–339. [Google Scholar] [CrossRef]
  16. Jiao, Z.; Chen, L.; Lu, X.; Liu, Z.; Zhou, X.; Zhuang, Y.; Guo, G. Carrier phase ranging with DTMB signals for urban pedestrian localization and GNSS aiding. Remote Sens. 2023, 15, 423. [Google Scholar] [CrossRef]
  17. Wang, M.; Cui, J.; Huang, Y.; Wu, W.; Du, X. Schmidt ST-EKF for autonomous land vehicle SINS/ODO/LDV integrated navigation. IEEE Trans. Instrum. Meas. 2021, 70, 8504909. [Google Scholar] [CrossRef]
  18. Li, X.; Yu, H.; Wang, X.; Li, S.; Zhou, Y.; Chang, H. FGO-GIL: Factor graph optimization-based GNSS RTK/INS/LiDAR tightly coupled integration for precise and continuous navigation. IEEE Sens. J. 2023, 23, 14534–14548. [Google Scholar] [CrossRef]
  19. Meng, J.; Ren, M.; Wang, P.; Zhang, J.; Mou, Y. Improving positioning accuracy via map matching algorithm for visual–inertial odometer. Sensors 2020, 20, 552. [Google Scholar] [CrossRef]
  20. Chen, W.; Yang, G.; Tu, Y. A Digital Track Map-Assisted SINS/OD Fusion Algorithm for Onboard Train Localization. Appl. Sci. 2023, 14, 247. [Google Scholar] [CrossRef]
  21. Zhou, Y.; Chen, Q.; Wang, R.; Jia, G.; Niu, X. Onboard train localization based on railway track irregularity matching. IEEE Trans. Instrum. Meas. 2022, 71, 9501013. [Google Scholar] [CrossRef]
  22. Sun, Z.; Tang, K.; Wang, X.; Wu, M.; Guo, Y. High-speed train tunnel navigation method based on integrated MIMU/ODO/MC navigation. Appl. Sci. 2021, 11, 3680. [Google Scholar] [CrossRef]
  23. Zhu, K.; Guo, X.; Jiang, C.; Xue, Y.; Li, Y.; Han, L.; Chen, Y. MIMU/odometer fusion with state constraints for vehicle positioning during BeiDou signal outage: Testing and results. Sensors 2020, 20, 2302. [Google Scholar] [CrossRef]
  24. Zhang, Q.; Chen, Q.; Niu, X.; Shi, C. Requirement assessment of the relative spatial accuracy of a motion-constrained GNSS/INS in shortwave track irregularity measurement. Sensors 2019, 19, 5296. [Google Scholar] [CrossRef] [PubMed]
  25. Zhou, Y.; Chen, Q.; Niu, X. Kinematic measurement of the railway track centerline position by GNSS/INS/odometer integration. IEEE Access 2019, 7, 157241–157253. [Google Scholar] [CrossRef]
  26. Wang, D.; Zhang, H.; Ge, B. Adaptive unscented Kalman filter for target tacking with time-varying noise covariance based on multi-sensor information fusion. Sensors 2021, 21, 5808. [Google Scholar] [CrossRef]
  27. Li, M.; Mourikis, A.I. High-precision, consistent EKF-based visual-inertial odometry. Int. J. Robot. Res. 2013, 32, 690–711. [Google Scholar] [CrossRef]
  28. Wang, Y.; Li, Y.; Zhao, Z. State Parameter Estimation of Intelligent Vehicles Based on an Adaptive Unscented Kalman Filter. Electronics 2023, 12, 1500. [Google Scholar] [CrossRef]
  29. Konatowski, S.; Kaniewski, P.; Matuszewski, J. Comparison of estimation accuracy of EKF, UKF and PF filters. Annu. Navig. 2016, 23, 69–87. [Google Scholar] [CrossRef]
  30. Dai, H.F.; Hu, B.Q.; Chen, Q. Robust adaptive UKF based on SVR for inertial based integrated navigation. Def. Technol. 2020, 16, 846–855. [Google Scholar]
  31. Meng, Y.; Gao, S.; Zhong, Y.; Hu, G.; Subic, A. Covariance matching based adaptive unscented Kalman filter for direct filtering in INS/GNSS integration. Acta Astronaut. 2016, 120, 171–181. [Google Scholar] [CrossRef]
  32. Lin, M.; Yoon, J.; Kim, B. Self-driving car location estimation based on a particle-aided unscented Kalman filter. Sensors 2020, 20, 2544. [Google Scholar] [CrossRef] [PubMed]
  33. Gu, P.; Jing, Z.; Wu, L. Adaptive fading factor unscented Kalman filter with application to target tracking. Aerosp. Syst. 2021, 4, 1–6. [Google Scholar] [CrossRef]
  34. Hu, G.; Gao, B.; Zhong, Y.; Ni, L.; Gu, C. Robust unscented Kalman filtering with measurement error detection for tightly coupled INS/GNSS integration in hypersonic vehicle navigation. IEEE Access 2019, 7, 151409–151421. [Google Scholar] [CrossRef]
  35. Li, Z.; Gao, J.; Wang, J.; Yao, Y. PPP/INS tightly coupled navigation using adaptive federated filter. GPS Solut. 2017, 21, 137–148. [Google Scholar] [CrossRef]
Figure 1. INS/ODO train combination positioning system with dynamic kinematic constraints.
Figure 1. INS/ODO train combination positioning system with dynamic kinematic constraints.
Electronics 13 03958 g001
Figure 2. Flow chart of the innovative adaptive UKF information fusion algorithm.
Figure 2. Flow chart of the innovative adaptive UKF information fusion algorithm.
Electronics 13 03958 g002
Figure 3. Train’s operational longitude–latitude trajectory.
Figure 3. Train’s operational longitude–latitude trajectory.
Electronics 13 03958 g003
Figure 4. Comparison of train position errors using different algorithms.
Figure 4. Comparison of train position errors using different algorithms.
Electronics 13 03958 g004
Figure 5. Comparison of train velocity errors of different algorithms.
Figure 5. Comparison of train velocity errors of different algorithms.
Electronics 13 03958 g005
Figure 6. Comparison of position errors of two positioning methods.
Figure 6. Comparison of position errors of two positioning methods.
Electronics 13 03958 g006
Figure 7. Comparison of velocity errors of two positioning methods.
Figure 7. Comparison of velocity errors of two positioning methods.
Electronics 13 03958 g007
Table 1. Parameter settings for positioning sensors.
Table 1. Parameter settings for positioning sensors.
Parameter EntryInitial Value
The constant error of the accelerometer 0.05 g
Random movement of the accelerometer 10 4 g / s
Zero bias characteristic of the gyroscope 0 . 05 / h
Random movements of gyroscopes 0 . 01 / h
Sampling frequency of INS100 Hz
Sampling frequency of ODO10 Hz
Table 2. Simulated satellite signal interruption.
Table 2. Simulated satellite signal interruption.
InterruptStart Time (GPST)End Time (GPST)Interrupt Duration
#145725045731060 s
#245735045741060 s
#345745045751060 s
#445755045761060 s
#545765045771060 s
Table 3. Comparison of position errors between two algorithms (m).
Table 3. Comparison of position errors between two algorithms (m).
Innovation Adaptive UKFUKF
NorthEastVerticalNorthEastVertical
#12.713.907.062.106.229.32
#23.122.246.565.620.687.74
#30.820.611.811.320.712.43
#40.400.320.220.830.320.37
#51.722.153.961.722.915.21
Mean0.170.281.220.250.331.56
RMSE1.411.342.151.132.002.76
Table 4. Comparison of velocity errors between two algorithms (m/s).
Table 4. Comparison of velocity errors between two algorithms (m/s).
Innovation Adaptive UKFUKF
NorthEastVerticalNorthEastVertical
#10.410.600.380.440.630.39
#20.320.230.480.350.250.56
#30.220.220.170.240.240.19
#40.160.160.180.210.180.23
#50.360.610.230.390.660.25
Mean0.020.020.040.040.030.05
RMSE0.070.080.120.110.130.14
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Li, X.; Zhang, J. Innovation Adaptive UKF Train Location Method Based on Kinematic Constraints. Electronics 2024, 13, 3958. https://doi.org/10.3390/electronics13193958

AMA Style

Li X, Zhang J. Innovation Adaptive UKF Train Location Method Based on Kinematic Constraints. Electronics. 2024; 13(19):3958. https://doi.org/10.3390/electronics13193958

Chicago/Turabian Style

Li, Xiaoping, and Jianbin Zhang. 2024. "Innovation Adaptive UKF Train Location Method Based on Kinematic Constraints" Electronics 13, no. 19: 3958. https://doi.org/10.3390/electronics13193958

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop