Bayesian Train Localization with Particle Filter, Loosely Coupled GNSS, IMU, and a Track Map

2016


Introduction
Train localization inside a railway network is necessary for a collision-free operation and mainly addressed by centralized traffic control, signaling, and sensors in the railway infrastructure.Onboard train localization in combination with communications enables distributed and train centric assistant systems such as collision avoidance, coupling, and autonomous train operation.This localization system concept focuses on exclusive onboard computation and sensors without any additional railway infrastructure.
Future railway systems such as a train centric collision avoidance system [1,2] require a localization system with continuous availability and a track-selective accuracy.Track selectivity is the ability to identify the correct track, especially in the critical, parallel track scenario after a ride on a divisive switch way.The track selectivity is the technical challenge and also the major requirement of train localization.
The goal of train localization is to determine the position of the train in the track network by topological coordinates, which are hidden variables and cannot be measured directly.
Single sensor systems, such as global navigation satellite systems (GNSS), are very beneficial for localization, but the measurement accuracy and lack of availability in parts of the railway environment do not fulfill the safety-critical requirements.
Research on train localization with onboard sensors focuses on the following question: how is a train-borne, safety-critical, and onboard localization system designed and analyzed in terms of data processing with continuous availability and a track-selective accuracy?The approach should cope with hidden variables as the topological position, imprecise information of measurements from multiple sensor sources, outages, statistical noise, and systematic measurement errors.
This paper presents a train localization approach by a Rao-Blackwellized particle filter (RBPF).Figure 1 shows the setup with onboard sensor data of an inertial measurement unit (IMU) and a GNSS receiver.The RBPF estimates the linear state variables of the one-dimensional train transition with Kalman filters within each particle of a particle filter.Furthermore, a novel empirical evaluation methodology is defined for track selectivity which is not specific to a certain train localization approach.This paper is considered as a follow-up of the theoretic probabilistic approach with a particle filter [3][4][5] using satellite range measurements.
The novel parts are the extension of the particle filter for train localization with a Rao-Blackwellization as well as an evaluation framework for track selectivity.The RBPF and a reference map-match approach are evaluated in terms of track-selective accuracy with real train data of a regional train.
The outline of this paper starts with a related work review, a general information for a map-based train localization in Section 3, and the description of the used sensors in Section 4. Section 5 contains the derivation of the Rao-Blackwellization and the RBPF implementation is given in Section 6.The track-selective evaluation (Section 7) evaluates the RBPF approach with data from train runs (Section 8).Sections 9 and 10 show the results and the discussions on results.

Related Work
There are multiple approaches of train localization in the literature with onboard sensors and a map.A selection of studies are chosen, which focus on track selectivity or specific sensor studies, which can identify the switch way.The different approaches vary in sensor types or combinations, processing methods, and evaluation scope and will be presented in these categories.
Inertial sensors are often used in combination with an integrated navigation system for GNSS position aiding, for example, in [6,7].The yaw turn rate can also be used for the switch way identification that has been used in [8,9] and analyzed in [10,11].Approaches with GNSS and IMU are found in [7][8][9] and extensions with eddy current sensor in [6,12,13].The eddy current sensor, in principle a metal detector for characteristic railway features, can be used for a switch way detection, as speed or displacement sensor.Sensors such as cameras [14,15] or LIDAR [16,17] can directly identify the different switch ways and contribute to the trackselective result.A study of a tightly coupled localization with raw GNSS data and a track map was shown in [5,18].A tightly coupled approach considers pseudorange, Doppler, and phase measurements and has the advantage to process location information even with less than four satellites in view.However, a tightly coupled approach is typically more complex to implement than a loosely coupled approach and a user clock offset needs to be estimated additionally.The processing methods of each study are different and dependent on the used sensors, filtering method, and algorithmic integration of the map.Saab proposed a train localization using a map-matching technique with a correlation of the curvature signature [19].For the track selectivity, there are two classes with map integration and estimation of importance: a multiple hypothesis filter handles and maintains multiple estimates on several tracks in the vicinity and is commonly used [6,9,13,17].The particle filter uses usually a large set of particles, which are location hypotheses on a map, and handles the different track hypotheses by particles.The particle filter with onboard sensors and a map was proposed in [20].Fouque and Bonnifait [18] defined a marginalized particle filter with raw GNSS data for the identification of the carriageway and along position of a road vehicle.Hensel et al. [12] showed a particle filter approach for railways based on just an eddy current sensor and a map.
Only few approaches evaluate data sets with statistics about track selectivity: Lauer and Stein [13] used GNSS and a velocity sensor and showed a gain in track-selective accuracy and confidence between a simple map-match and a proposed estimation algorithm.Hensel et al. [12] showed no direct figures on switch way resolution but improved switch detection (98.23%) and classification (99.64%) with an eddy current sensor of 861 switches.This study focused on switches as position input and classifications on merging and splitting switch runs.Böhringer [6] evaluated an integrated navigation system (GNSS, IMU) in combination with an eddy current sensor for switch way identification.Even with a moderate switch detection rate of 70%, the results received 99.78% of track-selective accuracy.These results are considered as most suitable for a comparison and are based on real train runs of 120 km with 113 switches.

Map-Based Railway Navigation
3.1.Topological Coordinates.The goal of train localization is to estimate the train position in the track network by topological coordinates as well as the train speed V.A unique and discrete track ID () identifies the track and the track length variable  is the one-dimensional position on that track.Each track has an origin and a direction  indicates if a train is oriented with or against the track definition.The topological coordinates are Tracks are connected by switches, crossings, or diamond switch crossings.A track  is defined between connections with a unique ID; that is, it contains no switch or crossing.This definition ensures that a track  is always one-dimensional and limited by the two endings of track beginning and track end.

Coordinate
Frames.The sensors measure in their specific sensor frame.For further processing, these measurements are converted in the train frame according to the mounting parameters.The map and especially the geometry of the tracks are expressed in the track frame.Any sample point of a track contains a geographic position (WGS84) and the track attitude angles are defined from a local frame in north, east, and down (NED).Once angles or curvatures are used in the map, there is an ambiguity about the direction at which the track ending the origin is defined.Therefore, it is necessary to define a start point and consequently a pointing direction of the track.A train (train frame) can be placed in two orientations on a track and can move forward or backwards.Alternatively to V, the train speed can be expressed between train and track frame by ṡ .The absolute velocities of V and ṡ are the same.The sign of ṡ indicates either an increasing (+) or decreasing (−) change of the position  of the current track and depends on the track definitions.
Throughout this approach, the map information of a specific location is converted and processed in the train frame.It should be noted that there is an alternative way to convert all variables to the track frame.Table 1 shows the conversions of the train direction variables: train-to-track frame direction (), the motion direction of the train (), and the direction of motion between train and track frame by the sign of ṡ .The motion direction  depends on a forward or backward velocity V regarding the train frame definition of front and rear.It is possible to compute any of these directions from the two others by Table 1.Direction  keeps its value during standstill.The motion direction  remains the same during a train run, while the sign of ṡ and  can alternate after a change of tracks during a train run.

Along Track and Cross Track.
A suitable analysis for topological localization performance is the approach by along and cross track.Along track addresses the continuous 1D localization on a track.Cross track focuses on discrete, different tracks and track selectivity is the ability of a correct cross track localization.Sensors can contribute to along and cross localization with relative or absolute measurements of displacement or track features.As shown in Figure 2,

Cross at switch
Absolute Absolute along (s) cross (id)   Realtive along (Δs) (id left , id right ) Odometry is the processing of relative along measurements, such as wheel turns, speed, and train acceleration.Depending on track features, parallel tracks show often very similar along and cross track features.Measurements may contribute to absolute along or cross in a local vicinity or even globally.

Railway Track
According to the train direction , the sign of the curvature   changes, while  changes by 180 ∘ .This special map can be constructed from train-side sensor data [7,21] or extracted from an existing geodatabase.An open street map (OSM) [22] geodatabase is used as data source for the track map.The main advantages of OSM are the availability and the completeness of data points of many tracks of the desired railway track network.For an adequate map, there is some additional preparation by track separation and topological connection (e.g., at switches) as well as geometry processing being necessary.An OSM data contains geodata points (, ) and the track geometry of heading () and heading curvature (  ) is derived from these positions.The data is usually collected from various sources, such as a GNSS hand-held or extracted from aerial or satellite photo with different and undefined accuracy.Therefore, an OSM data based map should not be considered as highly accurate.An analysis of many train runs showed lateral deviations up to 5 m between an averaged GNSS trace and the OSM track.
The estimation state vector or train state  est  for one discrete time step  is defined by The train-to-track frame speed ṡ can be computed by Table 1: The bias vector   contains correlated sensor errors.These biases change over time due to a random drift, which cannot be calibrated in advance.Additionally to the state variables, an auxiliary variable  is used to represent the vehicle motion by  ∈ {forward, stop, backward}.The goal for a train localization algorithm is to estimate and resolve  est  and   .
The strong track-train constraint allows to predict the train position, attitude, and inertial state from the known track geometry of the map.These extended train states are computed from the map by the actual topological position estimate and contains the geometry in train frame ( and   transformation according to ): 3.8.Train Control.The train control consists of cross track control and the along-track control by the train driver: The cross control influences the travel path of the train by the selected switch way ( sw : {left, right}).This is usually controlled by a train control center or sometimes by the train driver at shunting yards or industrial tracks.The train driver controls the general train motion   and the acceleration  acc by the traction and brake lever.The general train motion is the travel direction selector as well as a train stop (e.g., activated parking brakes).The control center has also influence on the along-track control via signaling.

Simple Map-Matching.
In contrast to state estimation a reference approach by simple map-matching is described.The simple map-matching is a snapshot based, nearest neighbor method, which uses no information about the prior position.The nearest position on track is computed with the map from a GNSS position measurement: ) .
It should be noted that this approach would be sufficient if the position measurement (e.g., ideal GNSS) is continuously available with an accuracy always better than half of the distance of parallel tracks.It will be shown in the results that this approach has its problems with real GNSS position measurements.

Train-Side Sensor Measurements
This paper focuses only on GNSS and IMU measurements, but other train-born sensors can extend the proposed approach.The used sensors are considered as inexpensive and their combination as complementary in terms of measurement errors.

Global Navigation Satellite Systems.
The approach uses the standard GNSS receiver output by position-velocity-time (PVT) and is considered as loosely coupled.That means that the internal GNSS related computations can be kept transparent, up-to-date with actual receiver technology and out of the train localization approach.The used receiver was a u-blox 6 GPS receiver, but also other commercial off-theshelf receivers could be used.
A drawback of GNSS is the lack of availability and degraded accuracy in parts of the railway environment.GNSS data is not available in tunnels or below station roofs.The accuracy is further affected by multipath, signal loss, and poor geometry in urban environments, next to acoustic noise barriers or in dense forests.

GNSS Speed.
The GNSS speed measurement contributes to the train odometry in terms of relative along-track estimation and is part of the PVT data.A single antenna mounting is invariant of a horizontal rotation; that is, the speed and also heading measurements are independent of the mounted yaw angle between antenna and train.In principle, the GNSS speed is computed from the vector norm of the antenna motion in north and east component.Therefore, the GNSS speed is always positive and the train motion () must be considered in the use-case for train speed.The measurement model contains the train speed ṡ , additional white noise , and a conversion for the train motion: 4.1.3.GNSS Heading.The GNSS heading angle contributes to the switch resolution which was described as cross at switch contribution in Section 3.3.There are multiple ways of the internal heading computation of the receiver: a simple differentiation of two consecutive positions or by computation of a receiver motion vector from Doppler and/or phase measurements of each satellite.The actual internal method is unknown, but state-of-the-art methods use positions and Doppler within a Kalman filter [23].The used receiver outputs an ECEF (earth centered, earth fixed) velocity vector, and the GNSS heading measurement is the angle to north of the horizontal part of this vector in east and north direction.
The receiver estimates further an accuracy of the velocity vector (ECEF) better than 1.1 km/h in 95% of all runs and a resulting heading accuracy of 1.7 ∘ in 95% of all runs above 10 km/h.The GNSS heading is worse at low speeds, so the heading measurements are used above 10 km/h.The GPS data of the experiment and the results showed a good heading repeatability with usually less than 1 ∘ of different runs over the same positions.In comparison, a heading angle between two consecutive positions showed much worse results.The heading model contains the heading angle  of the train (train frame) which is derived from the estimate of the topological pose and the map.A GNSS heading measurement with single antenna is the heading of the antenna motion and requires a conversion to train frame by the train motion  (see also Table 1): It should be noted that there are no heading measurements for very low speeds or stopped trains.

Inertial Sensor.
The IMU measurements provide continuous and interference-free data.Two measurements are of particular interest: the longitudinal acceleration (  ) and the yaw turn rate (  ).The measurements are aligned with the train frame by prior calibration.

Longitudinal Acceleration.
The longitudinal acceleration (  ) measures the train acceleration measurement and it contributes to the relative along localization (odometry).
The along acceleration measurement model considers train acceleration , the gravity  portion by the slope angle  of the track, and accelerometer bias   : Inertial sensors are affected by a bias which is changing over time, called drift.Any bias causes growing errors, as the train acceleration is integrated over time to speed and position.The presented approach does not contain a slope estimation or slope profile in the map.The slope angles of railway tracks are relatively small and the bias estimation in the following handles the difference.A continuous estimation of the combined offset b is processed and contains bias and gravity portion from slope.Extensions with slope estimation by integration or a slope profile in the map are possible.

Yaw Turn Rate.
Rails are a strong constraint between track geometry and train trajectory.It is possible to measure the geometric characteristics with a train-side IMU of a moving train.A certain curvature   of a track causes yaw turn rates depending on the train speed: A complete model of train kinematics for turn rates and centripetal accelerations is presented in [21].Trains are exposed to low pitch and roll angles in general and especially at switches.As a consequence, the horizontal heading turn rate ψ can be approximated by the yaw rate of the train: The curvature as measurable track feature indicates absolute along locations and resolves different switch ways (cross at switch).This approach is less sensitive to drift as it does not rely on integration of the inertial measurements.This property is advantageous for the use of low-cost MEMS gyroscopes.The measurement model ℎ  of the yaw rate measurement   is defined by At this point, the frame and motion definitions are vital (Table 1).The curvature is translated to train frame by train direction  and the speed contains the motion direction  in its sign.The bias of the gyroscope (  ) is calibrated only during stop phases of the train: The turn rates are assumed to be zero and the low earth turn rate is neglected.The resulting small error is not integrated in the following (e.g., as in strapdown approaches) and results in a negligible error at the weighting process by a likelihood.

Probabilistic Train Localization
The following definitions can be used for a multihypothesis filter, a particle filter or Rao-Blackwellized particle filter.The posterior is already specified for GNSS and IMU sensors.
The factorized posterior is proportional (∝) to the posterior, because of a missing normalization factor.This normalization can be computed separately, as all probabilities sum up to one.There are different considerable filter approaches, which are able to estimate the nonlinear train transition and the different hypotheses of the topological pose.

Along Track.
One extension to the previous particle filter approaches [3,4] is the separation of states, where certain states are estimated differently.In combination with particle filters, this process is called Rao-Blackwellization [24].In particular the linear states can be separated from the nonlinear states of a particle hypotheses and estimated by a more optimal filter, as the Kalman filter.The train state contains linear and nonlinear parts:   = {   ,    }.The train transition of 16 is split in a linear and nonlinear part via chain rule and conditional independencies that are removed: The state transition of the odometry prediction step is defined here as a 1D transition DWPA model (discrete white noise constant acceleration) [25].The linear 1D train transition and the acceleration bias are estimated by the discrete model: This model is propagated by state-of-the-art Kalman filter and updated with GNSS speed and longitudinal IMU acceleration measurements.

Track Transition Model.
The track transition ensures that the estimates (hypotheses, particles) exist and stay exclusively on tracks.The nonlinear train transition of (17) estimates a topological coordinate from the linear displacement, the previous coordinate, an unknown switch way, and the map: The function of the map for each hypothesis (particle) is This model considers the discontinuity at a track change and in case of a splitting switch scenario the next track is sampled from a discrete uniform distribution (left or right).According to the motion state of standstill ( = STOP), this transition can be suspended.The next step is a track map query by the topological pose for each hypotheses or particle.The extended train state  ext  contains the track geometry in train frame: ) .

Particle Filter Approach
A particle filter is chosen for the posterior (16) estimation.
The particle filter can handle different nonlinear estimates (hypotheses) automatically by the particles, which is necessary for a distribution of any possible position over different tracks.As described in [26], a particle filter represents probability density functions by appropriate particle distributions with appropriate weights of   particles.The posterior of ( 16) is represented by the particles set: 0: is the th particle with its weight   of   particles and represents one sample of the posterior of all time steps until .Particles are generated from a function which is easy to calculate [26], called the proposal function: Afterward these particles are weighted [26].The weights are proportional to the fraction posterior over proposal function: The weights of the particle filter sum up to one and the normalization factor  can be easily computed: After several time steps, some particles may carry an extreme high weight while the rest has a very low weight.These low weighted particles are inefficient and this process is called degeneration.In order to avoid this, a systematic resampling [26] of the particle distribution can solve this problem.
A metric for particle depletion is the effective number of particles Neff [25].The particle distribution is resampled if Neff is below a threshold  th .

Particle Filter with GNSS and IMU Measurements
6.1.1.Proposal Function.The proposal function is designed by the transitions of train and correlated sensor properties as well as suitable measurements.The proposal contains the train odometry estimation of Section 5.2.1 and a gyroscope bias estimation.In this implementation, the gyroscope bias is only updated if the train is not moving.The displacement of the th particle is sampled from the odometry Kalman filter output: In contrast to previous approaches [3,4], the samples were directly generated from an acceleration distribution and a motion model.The use of the odometry Kalman filter inside of a particle filter is the Rao-Blackwellization part.
The nonlinear map transition of ( 21) and map query ( 22) is processed for each particle as a function of the map.

Weight Function.
The weight function is the combination of IMU and GPS likelihoods and computed as shown in (23) with the appropriate measurement models ( 9), (10), and (14).The weight function for the th particle with the IMU and GNSS likelihoods is (29) 6.1.3.Initialization.The initial particle distribution is generated from the first GNSS position measurement.Therefore, the 2D geoposition is sampled   times with a large covariance Σ (e.g., 100 m) from a Gaussian distribution: The positions are map-matched by (7) to topological positions and assigned to each particle .The train frame direction  is sampled randomly from a uniform distribution.

Output Estimate.
A particle distribution is a less useful output for applications like automated train control or collision avoidance.There, a single mode or most likely output is desired.Internally, the particle filter keeps its particle distribution for the next update.The output is computed by four steps: first, the track paths are identified and, second, the most likely track path with particles is chosen (ML path).A mean square estimate is computed from particles on that path and the result is translated back to topological coordinates.

Track Path Identification.
At first, all path hypotheses   with at least one particle are identified: A track path contains one or more sequential tracks () on a 1D path, where a train is able to run over in a sequence.
For further computations, a track path has a continuous 1D coordinate frame compared to discontinuities at the joints of tracks.A topological pose can be translated into path coordinates as well as translated from path coordinates.As an example, in case of a split switch scenario, particles can be distributed before the switch, on the left and right switch way.This would result in two possible track paths:  1  = { before ,  left } and  2  = { before ,  right }.

ML
The delta function (  =  ∈    ) equals one if the th particle (respective its track ID ) is on the th track path and is zero otherwise.The most likely path  ML  is the path index  with the highest cumulative weight ŵML :  =  arg max  (ŵ  ) . (33)

Mean Square Estimate on Path.
In the following, a delta function selects the th particle which is on the most likely path: The topological coordinates of the selected particles are translated to the most likely path: Ttopo, : {,s, d} =  topo2path ( topo, ,   ) .
The 1D position is calculated by a weighted mean of the selected particles, which belong to the ML path: The 1D position deviation (along-track precision) is calculated by the weighted sample variance of particles from  ML  : The train direction on track  is computed by the highest weight, where  is either positive or negative track frame direction of the path: The most likely direction is the one with the higher weight.
The procedure for train motion direction  is analog.

Translation to Topological
Pose.Finally, the most likely path  ML  , the weighted mean position ŝ on path, and the train to path frame direction d ML are translated into topological coordinate frame: (39)

Algorithm Summary. The algorithm of the sequential
Bayesian filter with a Rao-Blackwellized filter realization (RBPF) is shown in Algorithm 1 and summarized in words: every new measurement (IMU or GNSS) triggers the filter to compute a next time step.Particles (hypotheses) estimate a topological position on railway tracks and these particles exist only on tracks.Each particle is shifted along the track by a displacement output from the odometry filter (Kalman filter), which is updated with GNSS speed and longitudinal acceleration data (IMU).A special function of the map processes this shift for topological coordinates.A railway switch is handled by a random assignment of the particles to each way.From the map, each particle is assigned with proposed geometric values in train frame of a geoposition, heading angle, and an instantaneous turn rate from curvature and speed.The likelihoods weigh the particles with a probability according to the difference of the proposed geometric values and the measurements (train frame) of GNSS position, GNSS motion vector heading, and IMU yaw rate.An output estimate extracts one train location with variances from the particles and resampling removes unlikely particle estimates.The design parameters are sensor (co)variances, process noise of train acceleration, and combined bias as well as number of particles, resample threshold, and variance of displacement sampling.

Particle Filter Challenges.
The challenges of this mapbased localization approach by a particle filter are the following.

Divergence in Along
Track.The problem is an unstable filter, as the estimate (particles) is away from the truth and cannot recover.This can be approached by a good model design (i.e., proposal function), a continued resampling, and the insertion of sampling noise.In case it fails, a filter monitoring can detect a severe along divergence (e.g., by GNSS measurements) and restart the filter.

Divergence in Cross Track.
The problem here is a failed track selectivity, as all particles are on the wrong track, in particular a parallel track, and cannot recover.The resolution of the switch way is very important.This requires a sufficient map model as well as sensors, which are able to measure the competing switch way properties.Another approach is the use of extrinsic sensors which directly measure the switch way (cross at switch) or observe a neighboring track (absolute cross).

Initialization.
In the start-up phase of the estimation filter, some hidden and discrete states remain unresolved if they are not directly observable by measurements.In the proposed approach, this happens for the train frame direction  and the track  in parallel track scenarios.There, the filter requires motion or motion over a switch to resolve these states.An alternative way is the use of extrinsic sensors in order to observe or resolve the hidden variables from standstill.

6.4.4.
Overconfidence.This happens especially if the measurement noise is too small and correlations are disregarded in the sensor model.The filter converges very quickly to the measurements and results in a too small particle distribution after resampling.This can lead to the described divergence in along and cross track.6.4.5.Degeneracy.Degeneracy of the particle distribution is the effect where nearly all weight is accumulated on one or a few particles.The state-of-the-art approach is systematic resampling [26].
6.4.6.Dimensionality and Computational Complexity.High dimensional state vectors can be problematic for particle filters, as the number of particles and computational complexity grows [27].This approach uses a state vector (3) with the nonlinear random variables of discrete track IDs , which is limited to a few tracks in the vicinity, a noncontinuous 1D position , and a binary direction .Once, the direction is resolved after initialization, the direction is processed in a deterministic manner and not estimated anymore.In other words, the particle filter estimates actually two states.The train acceleration, speed, and certain biases are processed by a linear filter in order to achieve more optimal estimation and to reduce the number of particles.

Track-Selective Evaluation Framework
The empirical proof of track selectivity is achieved by the comparison of localization output and a reference route.This reference must be known in advance and is the true sequence of traveled track IDs.Of special interest is the switch scenario with a splitting switch way run, as shown in Figure 3. Railway switches have a region where the clearance of two vehicles overlap, and only one train can occupy these tracks.There, a false track estimate is tolerated and not a real problem as only one train can occupy the tracks.The length of this tolerance region can either be fixed or individual for every switch, stored within the map.For simplicity reasons, a fixed tolerance of 50 m after a switch start is chosen.The trackselective accuracy is evaluated with the known route (ground truth) and a false track estimate within the tolerance region is marked in orange, a correct estimate is green, and a false one is red.Track precision is defined here as the discrete probability of the track estimate from the filter output.A high precision estimate can be evaluated with an incorrect accuracy, when the true track is different.
The track-selective accuracy can be analyzed over time (per second) or over traveled distance (per meter).Train statistics are often related to distance (e.g., millions of train kilometers), so the results are presented in relation to the traveled distance.The method of Algorithm 2 evaluates the train localization estimate of each time step.
A cumulative evaluation shows the performance of the localization approach in terms of track selectivity for larger data sets.Each evaluation result is shown relative to the total distance: This method is based on distances which automatically rejects the evaluation of stopped and parked trains.Track-selective errors occur in the presence of parallel tracks.A train run on a route with more single track scenarios will distort an evaluation in favor of a better track-selective evaluation.An increase of comparability of the evaluation result is considered with a ratio to distances with parallel tracks in vicinity: The switch tolerance evaluation suits mainly for detailed evaluation on small changes and tuning.
A compact figure of the evaluation () in terms of track selectivity over parallel tracks distances (TS, ) is the errorfree case of multiple track scenarios: This figure explains how good a certain train localization approach performs on a specific track network.This cumulative evaluation is one way to measure the track selectivity performance and contains to some extent the track layout of parallel tracks and switch densities.Another evaluation measure is the error events, which counts and evaluates the transition to the wrong track.One faulty switch resolution results in a cumulative error dependent on the specific track length.A parallel track scenario merges very often by a switch after a station and a wrong output can be on the correct track again.The error event method counts transitions to the error case and respects more the error cause, which is a fault switch It differs The track-selective evaluation in multiple tracks scenarios  TS and the switch way resolution evaluation  SW will be used as compact results.

Experiment
8.1.Recorded Data Set.The data set was recorded on the regional train "Alstom Coradia Lint 41" under regular passenger service conditions.This train can travel up to 120 km/h and has two drivers' cabs for two-side operation.Table 2 shows the train runs over 230 km with 107 splitting switches.The train runs on 58.5 km of tracks with other tracks near or in parallel, which are 25.4% of all tracks.The data set contains GNSS PVT data (position, velocity, time) of GPS (Global Positioning System) from a u-blox LEA 6T receiver.The IMU data (Xsens MTi) was recorded with a sample rate of 200 Hz and time stamped from a GPS synchronous clock.For the proposed algorithm, this IMU data was low-pass filtered and downsampled to 4 Hz.The IMU was placed on the front bogie, the GNSS antenna below a fiberglass roof above the bogie position.A special camera (dash-cam) with GPS timestamped video was installed behind the front windshield for the switch way evaluation.

Labeled Reference Route.
The reference for the cross track analysis is a recorded video from the train run.In that video, the motion state can be seen, the switch way and direction of travel.For every run, a reference travel path (i.e., labeled data) can be computed from a start position (GNSS), train direction, the map, and a series of true splitting switch ways.These switch ways are either "left" or "right" and obtained manually from the video.

Implementation.
The localization algorithm approaches were implemented within a self-written JAVA framework.This includes the map processing, the sensor data reader, and the evaluation.The sensor data was processed in a causal way; that is, the localization approach processed each measurement in the chronological order and the output was evaluated.No simulated (i.e., generated) data was used.Particle filters are generally computationally expensive by nature.Nevertheless, the temporal performance for (  = 100) particles with visualization was processed 19.0 times faster than real time on a laptop (Intel i7M CPU, 2.9 GHz, Windows 7).Hence, a real time operation is possible.Figure 5 shows the results of the simple map-matched GNSS positions for Run 1 over time.The correct track is marked with OK in green, an error in the tolerance area in   the vicinity of the switch is yellow, and a wrong track is red.There is no track precision shown, as this approach considers no uncertainty but only the nearest track.

Results
Figure 6 shows the accuracy and precision results over time of the realized Bayesian filter with IMU and GNSS of Run 1.At one splitting switch, the filter was estimating an incorrect track within the tolerance region.The track precision (middle plot) is shortly reduced with the occurrence of split switches as seen in Figure 4.The along precision (bottom plot) is initially coarse but quickly drops after train departure to an average of 1.4 m.This along precision is the weighed empirical deviation of the particle distribution of (37).

Cumulative Track Selectivity.
A detailed cumulative evaluation is presented in Table 3.Five localization methods are evaluated, in particular the simple map-matching and four different Rao-Blackwellized particle filter implementations (RBPF).The number of particles is   = 100 in all RBPF evaluations.Each accuracy category is shown in percentage of the total distance of 230 km.As all methods solve the single track scenarios, the track accuracy is shown additionally relative to the total distance of multiple track scenarios (58.5 km) in parenthesis.The evaluation results of a standing train periods are disregarded in this table.The error events in Table 3 indicate how often a transition to wrong tracks happened.Depending on the method, this can be traced back to faulty switch resolution.A late switch error represents a resolved switch way after the evaluation threshold, whereas a failed switch relates to a wrong resolved switch way.The compact results according to (42) and (43) are presented in Table 4.There are no switch way resolution results for Method 1 as the simple map-match considers only the nearest track and does not resolve a switch way.

Discussion
10.1.Discussion on Results.One major goal of train localization is a track-selective estimation result.As seen from Table 3, Method 1 (reference approach of simple mapmatching) has severe problems to determine the correct track at 21.9% of parallel tracks.The proposed algorithm RBPF uses also GNSS positions (Method 2) but shows some improvement with 16.0% of wrong tracks on multiple track scenarios for 33 times.The filtered methods, especially the last three, converge to one track in a parallel track scenario.There, the switch resolution is essential and a failed switch forces the estimate to stay on the wrong track until a merging switch to the true track corrects the estimate again.For example, Method 3 shows an improvement in error events but stays three times on a wrong, parallel track.
The best results are achieved with Method 4 (RBPF with yaw rate) on 99.3% of parallel tracks which relates to an error of 6.7⋅10 −3 and stands for a false localization on 394 m (24.8 s) in total.With two late and one failed resolved switch way, Method 4 achieves 97.2% in switch way resolution, respective of an error of 2.8 ⋅ 10 −2 .
The definition or adjustment on the switch way evaluation threshold has direct impact on the results and was 50 m.In case this threshold tends to 0 m, the track-selective results over distance can be extracted from the "OK" column of Table 3 and are slightly worse.However, the switch way resolution results of (43) will severely decrease with a zero tolerance area by many late resolved switches.
The results are quite sensitive to the parameters such as measurement noise, the noise ratio of different measurements, resampling occurrence, process, and sampling noise as well as the map quality.Better or even perfect results may be expected by exhaustive optimization of the map and filter parameters.As an unwanted consequence, map and parameters may match this limited data set and the results loose generality.Nevertheless, the following tendencies can be seen from the results: the additional use of the GNSS heading (Method 3) shows only little improvements with 9.8% in terms of errors compared to Method 2 (GNSS position only).Further, the combination of all likelihoods of Method 5 (GNSS position and heading, IMU yaw rate) does not show an improvement.The most likely explanation of this effect might be the map with its coarse heading and curvature geometry.These values are derived from positions and are consequently dependent.Slightly wrong positions cause an error in both values.Because of this dependency the combination of the measurements has no further gain in accuracy.
For the realized implementation of the sequential Bayesian filter, the particle filter approach was chosen, as the particles can sample the different hypotheses and any nonlinear distribution.The Rao-Blackwellization marginalizes the linear state variables and estimates them with a Kalman filter.As a consequence, the particle filter samples only the cross track hypotheses () and the along positions ().The number of particles are relatively low (  = 100) as the particles are limited and constraint on the tracks.Additionally, the linear state variables are estimated by nested Kalman filters (Rao-Blackwellization).A particle filter approximates distributions and induces two times additional noise as a tradeoff for convergence reasons: the sampling adds noise, which is needed to maintain particle diversity as well as the resampling in order to avoid particle depletion and divergence.[13] (GNSS, velocity sensor) showed a gain in confidence about the track decision between a simple map-match and the proposed estimation algorithm.A similar gain can be seen between simple mapmatch (Method 1) and RBPF with GNSS positions only (Method 2).Böhringer [6] received slightly better trackselective results (99.78%) compared to Method 4 (99.33%) with a different data set and an algorithm with additional eddy current sensor as switch way detector.Hensel et al. [12] do not consider explicit figures on switch way resolution.From switch detection and classification rates over 99%, a switch way resolution may be deduced with a similar performance.In comparison, Method 4 reaches 97.2% of correct switch way resolution even without an eddy current sensor and a coarse geometric map from OSM data.

Comparison. Lauer and Stein
However, a direct comparison between other approaches is not obvious as different data sets and different evaluation metrics are in use.Therefore, comparative results can be seen as quite similar as the differences are marginal for different data sets and metrics.Finally, from the literature and the present results, it can be reasoned that most of the gain in accuracy can be achieved by using an estimation filter as well as using sensors which can measure the competing switch ways.As this is quite expectable, further investigations are necessary to identify the smaller gains and differences of varied filters or sensor fusion approaches on the same data set.

Proposed Enhancements
Several directions of performance improvements of train localization are identified.
11.1.Advances of the RBPF.The particle filter can be improved with advanced procedures for better particle diversity on along track.Secondly, an enhanced resampling timing may be investigated, which suspends resampling near switches for an undisturbed switch way resolution.

Improved Odometry.
The along-track odometry can be extended with slope estimation from IMU pitch rate integration, map information about slope, or gravity vector estimation from acceleration measurements.A slope consideration would increase the accuracy of relative alongtrack estimation and also increase the range to propagate localization in GNSS denied areas.

Additional Sensors.
A further increase in track-selective accuracy, outage robustness, and redundancy can be considered with the use of extrinsic sensors, such as magnetic sensors, cameras, LIDAR, or aperture radar with direct switch way measurements.

More Accurate
Map.An accurate curvature and heading information in the map is a crucial factor for a correct switch way resolution with GNSS and IMU.The major advantage of generating a map from an OSM data base is to obtain a track map of a certain railway network size with a sufficient number of tracks.A map generation approach from onboard sensor data is presented in [7,21].
Furthermore, a direct comparison of alternative methods and sensors may be evaluated with same data sets and evaluation metrics.Studies could investigate the accuracy of different algorithms (e.g., multihypothesis filter versus particle filter), or the accuracy gain of different sensor data integration schemes (e.g., loosely coupled GNSS versus tightly coupled).

Summary
This paper presents a probabilistic train localization approach with a track-selective evaluation.In contrast to other approaches, this train localization comprises a Rao-Blackwellized particle filter (RBPF), a map of the railway tracks and sensor data of a GNSS receiver (Global Navigation Satellite System), and an IMU (inertial measurement unit).A novel RBPF implementation is presented which estimates the train localization posterior recursively.The Rao-Blackwellization marginalizes the linear state variables and estimates them with a Kalman filter.As a consequence, the particle filter samples only the cross track hypotheses () and the along positions ().The RBPF estimates directly the topological track coordinates; that is, the particles stay on the tracks.Further, a particle distribution can handle different track hypotheses and other nonlinear distributions.The map contains prior knowledge for the measurement models such as the track geometry data.The RBPF is able to resolve the unknown train-to-track orientation at initialization and can handle forward and backward runs of the train.
A novel evaluation method for track selectivity evaluates the localization results with real data recorded from a regional train.This generic evaluation method can be used to generate more comparable results of different approaches with different sensors and measurement data.Train runs were analyzed over 230 km of tracks with 107 split switches and parallel track scenarios of 58.5 km.Further improvements for a safety-of-life train localization of the special realization are discussed towards higher reliability of track selectivity.
The best combination of RBPF filter with GNSS positions and IMU yaw rates showed a track-selective performance of 99.3% on tracks with multiple tracks in the vicinity and 97.2% of successfully resolved switch ways within the tolerance.The realized RBPF approach with GNSS, IMU, and a track map showed promising results towards a track-selective and continuous train localization even with low-cost sensors and runs in real time.

Figure 1 :
Figure 1: Bayesian train localization setup with GNSS, IMU, and a track map.

Figure 2 :
Figure 2: Along and cross track definitions.

) 4 . 1 . 2 .
GNSS Positions.GNSS positions are a favorable measurement for absolute along and cross resolution of the train location.The GNSS position model includes 2D positions of latitude  and longitude  and additional white noise  pos :

5. 1 .
Train Localization Posterior.The train localization posterior represents the estimation problem.In previous works[3,4,21], Bayesian methods are presented with a dynamic Bayesian network definition for the train localization problem and the factorization of the posterior is shown in steps.The posterior of all train states ( 0: ) and sensor biases ( 0: ) over  time steps are estimated given all measurements ( 0: ), train control inputs ( 0: ), and the map ().The map is actually known in advance and does not change over time for the train localization problem.It is included in the conditional part of the distributions to indicate where information of the map is needed.The unknown train control is also included to indicate where a train driver or train control can influence the train states.The posterior is factorized in a recursive form in order to compute the posterior practically with estimation algorithms: nonlinear train transition on tracks ⋅  (   |   −1 ,   ) ⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟ linear train transition .(17) 5.2.1.Train Odometry Filter.The linear and one-dimensional train transition is separated from the nonlinear transition on the map and estimated with a Kalman filter.The estimation of the linear state variables of acceleration , speed V, and displacement Δ will be called odometry in the following.The odometry combines also the along acceleration bias estimation with updates from acceleration and speed measurements:  (   |   −1 ,   ) ⋅  ( ax  |  ax −1 ) ⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟ odometry prediction ⋅  ( GNSS,V  |    ) ⋅  ( IMU,ax Path.As a next step, the sum of weights are calculated for each path : ŵ =  ∑ =1   ⋅ (  =  ∈    ) ⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟⏟ selects weight of th particle from the th path   .

Figure 3 :
Figure 3: Cross track analysis at a switch with tolerance and error areas for a true right (straight) run.

Figure 4 :
Figure 4: Run 1 over time from Augsburg main station to Friedberg station with known switch ways.

9. 1 .
Track Selectivity over Time.Two different evaluations of the reference approach and the proposed algorithm are shown of Run 1 over time.Therefore, the train speed and true switch ways of Run 1 are shown over time in Figure 4.It visualizes the occurrence of splitting switch ways, since their resolution is the challenge for a train localization filter.

Figure 6 :
Figure 6: Track-selective accuracy and estimation precision of the Bayesian filter approach: RBPF with GNSS position, heading, and IMU yaw rate.

Table 2 :
Train routes.also in late switch way resolution, if the output is correct again within the correct track which connects to the switch.From these error events, the correct switch way evaluation ( SW ) statistics can be computed of the total split switches  total , the late resolved switch ways after the switch tolerance  late and the wrong resolved switch ways  failed :

Table 4 :
Compact track selective results.