EP2796337B1 - Method for determining the track course of a track bound vehicle - Google Patents
Method for determining the track course of a track bound vehicle Download PDFInfo
- Publication number
- EP2796337B1 EP2796337B1 EP13164791.9A EP13164791A EP2796337B1 EP 2796337 B1 EP2796337 B1 EP 2796337B1 EP 13164791 A EP13164791 A EP 13164791A EP 2796337 B1 EP2796337 B1 EP 2796337B1
- Authority
- EP
- European Patent Office
- Prior art keywords
- track
- curvature
- value
- error
- probability
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 74
- 238000009826 distribution Methods 0.000 claims description 42
- 230000001133 acceleration Effects 0.000 claims description 23
- 238000005259 measurement Methods 0.000 claims description 19
- 230000003068 static effect Effects 0.000 claims description 2
- 230000007774 longterm Effects 0.000 claims 1
- 238000012360 testing method Methods 0.000 description 35
- 239000013598 vector Substances 0.000 description 15
- 230000000875 corresponding effect Effects 0.000 description 9
- 238000001514 detection method Methods 0.000 description 9
- 238000013459 approach Methods 0.000 description 7
- 230000004807 localization Effects 0.000 description 7
- 230000008569 process Effects 0.000 description 7
- 230000005484 gravity Effects 0.000 description 5
- 230000033001 locomotion Effects 0.000 description 5
- 238000004088 simulation Methods 0.000 description 5
- 230000005653 Brownian motion process Effects 0.000 description 4
- 238000005537 brownian motion Methods 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 4
- 230000007717 exclusion Effects 0.000 description 4
- 230000014509 gene expression Effects 0.000 description 4
- 230000010354 integration Effects 0.000 description 4
- 230000007704 transition Effects 0.000 description 4
- 230000001419 dependent effect Effects 0.000 description 3
- 238000006073 displacement reaction Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 238000005070 sampling Methods 0.000 description 3
- 101100228469 Caenorhabditis elegans exp-1 gene Proteins 0.000 description 2
- 238000000342 Monte Carlo simulation Methods 0.000 description 2
- 238000009794 Ornstein-Uhlenbeck process Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000011835 investigation Methods 0.000 description 2
- 241001061260 Emmelichthys struhsakeri Species 0.000 description 1
- 206010034719 Personality change Diseases 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 238000005311 autocorrelation function Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000015556 catabolic process Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 238000006731 degradation reaction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000009792 diffusion process Methods 0.000 description 1
- 239000006185 dispersion Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 231100001261 hazardous Toxicity 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- PMHURSZHKKJGBM-UHFFFAOYSA-N isoxaben Chemical compound O1N=C(C(C)(CC)CC)C=C1NC(=O)C1=C(OC)C=CC=C1OC PMHURSZHKKJGBM-UHFFFAOYSA-N 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000005654 stationary process Effects 0.000 description 1
- 238000005309 stochastic process Methods 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
- B61L25/00—Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
- B61L25/02—Indicating or recording positions or identities of vehicles or trains
- B61L25/026—Relative localisation, e.g. using odometer
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
- B61L2205/00—Communication or navigation systems for railway traffic
- B61L2205/04—Satellite based navigation systems, e.g. global positioning system [GPS]
Definitions
- the invention is related to a method for determining the track course of a track bound vehicle.
- a track bound vehicle can be for example a train or another vehicle in railroad traffic. Further, it can be any other vehicle which is bound to a track, meaning the vehicle is not able to leave this track under ordinary conditions.
- inertial sensors For this purpose, it is known to use inertial sensors.
- a drawback when using inertial sensors is that no method is known in order to determine the reliability of a determination of the position of the vehicle based on their function. For applications which are relevant to safety, for example in railroad traffic, this information is required.
- the inventive method for determining the track course of a track bound vehicle comprises the following method steps:
- the inventive method can be used for a plurality of applications which will be described in more detail later.
- the first and second wrong decision probability can be identical or differ from each other.
- first and second error distribution in particular for each user sensor are determined each by a long time measurement in a static laboratory environment meaning that the conditions which might influence the function of the sensors are kept constant in this environment so that the exact error distribution of the sensor or sensors used can be determined. It is preferred that the first and the second error distribution are estimated.
- the quality of the performed curvature determination is determined in terms of a wrong decision probability.
- Standard curvatures in railroad traffic can be for example 0.4x10 ⁇ (-3) l/m for a radius of 2.5km til 5.26x10 ⁇ (-3) l/m for a radius of 190m.
- a decision between the first estimated curvature k ⁇ 1 and the second estimated curvature value k ⁇ 2 is taken such that the value leading to the lowest wrong decision probability is chosen.
- the minimum distance between k1 and k2 is obtained such that the reliability requirements (Pfa and Pmd) are just fulfilled. That is for any k3>k2, the probability of miss-detection is smaller than the required on: Pmd(k3) ⁇ Pmd(k2)
- a further possible application of the inventive method is to determine a minimum difference between two standard curvatures which is required to be able to distinguish between them with a predefined wrong decision probability. For example it might follow from the inventive method that a minimum difference of 0.45x10 -3 l/m is necessary in order to fulfill the predefined wrong decision probability 10 -5 at a velocity of 36.72km/h.
- the wrong decision probability can be a value between 10 -4 and 10 -6 .
- a further possible application of the inventive method is that a minimum speed can be specified for the vehicle for passing a switch which is required in order to be able to determine the correct function of the switch with a predefined wrong decision probability.
- a minimum speed can be specified for the vehicle for passing a switch which is required in order to be able to determine the correct function of the switch with a predefined wrong decision probability.
- the track curvature of the track bound vehicle is measured by at least one sensor in or at the track bound vehicle.
- the inventive method can be used as a subsidiary system which is part of an overall system (for example a system for localizing a vehicle in a map).
- an overall system for example a system for localizing a vehicle in a map.
- a curvature of the track course of the vehicle is determined. If this is done only in one snap-shot it is possible to reduce the number of possible positions of the vehicle in a map to all these positions which have the specified curvature. As an alternative it is possible to determine a plurality of subsequent curvatures, meaning that a plurality of curvatures of the vehicle is recorded over time. These recorded curvatures can be compared to the curvatures on a map so that it is possible to precisely identify the track course of the vehicle on the map.
- the inventive method can be used in order to determine sensor errors, so that the sensor can be calibrated.
- the track curvature is determined by using the above described sensors in particular based on three different methods which will be described later in more detail.
- each of these three curvature determination methods can result in a different minimum detectable curvature difference and a different vehicle speed dependency. For example, one method might result in lower required vehicle speeds which are necessary in order to be able to fulfill a required predefined wrong decision probability at different standard curvatures while another method might require higher speeds for the same preconditions. Since the performance order of the three methods is not constant over speed, it is preferred to switch between the three curvature determination methods depending on the speed and sensor quality. For example, if automotive grade sensors are used, it might be beneficial to use method 2 for 0-45km/h and method 3 for higher speeds ( Figure 10 ).
- this curvature determination method for a first speed range which allows the vehicle to travel with lower speeds at given curvatures and wrong decision probabilities while a second (and possibly third) different curvature determination method is used for another speed range in which this other curvature determination method allows the vehicle to travel with lower speed in order to achieve the same results.
- each method it is further possible to adapt the weight of each method depending on the camber of a track (namely the rotation around an x-axis running parallel to the longitudinal direction of the vehicle). It is further possible to choose the weight of each method based on an ascending or descending slope of the track (namely a rotation around the y-axis of the vehicle).
- Fig. 1 shows qualitatively the expected error distribution p k ( k ⁇ ) of a curvature determination error.
- the error distribution is used as an input for a threshold test, which for example can result in a minimum required curvature difference between two tracks.
- a first threshold T 1 is defined in the first error distribution (see Fig. 2 ).
- the probability of false alert is marked with P fa in Fig. 2 .
- the probability of misdetection is marked with P md in Fig. 3 .Since both probabilities characterize the allowed decision error for either curvature one or two, they could be considered equal and can be called probability of wrong decision.
- Fig. 4 shows some examples of these MDCD values, whereby three different curvature determination methods and inertial sensors of very high quality have been used.
- the curvature difference minima shown in Fig. 4 have been calculated based on a wrong decision probability of 10 -5 and tactical grade sensors. They are further dependent on the speed of the vehicle.
- the horizontal lines indicate the standard curvatures which are used in German railroad traffic (and their differences). The end of each of these horizontal lines indicates the maximum speed on these tracks. Therefore, the right, upper area shows vehicle speeds which are higher than the allowed German maximum speed on the respective track and hence, they are not relevant.
- the inventive method can also be applied for determining the position of the vehicle in a three dimensional space. In this case additional sensors will be necessary since a three dimensional position cannot be determined by using the described three sensors.
- a more complex error model can be used for example by assuming that the bias of the sensors is defective meaning that it is not constant over a time. The same applies to the scale factor of the sensors.
- the two main methods are map matching and dead reckoning system.
- the former obtains an absolute 3D position estimating using GNSS and additional sensors for each epoch and matches this position with the track map. This could be done by choosing the closest point in the track as the best estimate.
- the second approach the movement of the train relatively to a reference point is estimated incorporating all available sensors. Hence the position within the map is directly known. This approach can provide a more accurate and reliable solution since no intermediate solution is computed.
- Train localization/navigation using GNSS and IMU has been investigated by many different authors some of them providing novel and promising techniques using Bayesian filters [6].
- An ideal accelerometer would directly sense m ( t ) but in a non ideal case, the measured acceleration or turn rate is decomposed into a proportional part (proportional to a scaling factor s f ) and a time dependent drift part b ( t ) .
- the offset b 0 stays constant during each run and is corrected by an initial calibration of the sensors.
- the sampling noise is assumed to be Gaussian distributed with zero-mean and a variance ⁇ m 2 .
- the first one uses a generator of the Ito-diffusion process defined by the stochastic differential equation and derive a partial differential equation, so called Kolmogorov Forward Equation or Fokker Planck Equation. Its solution is a transition probability density function of the solution process (see [4] and [3]).
- the second method takes advantage of the fact that the process solution is Gaussian distributed, if the initial state densities can be assumed to be also Gaussian distributed. Hence, it is sufficient to investigate the evolution of the corresponding expectation and variance of the transition density function. In the section below, we apply the second concept and discuss the results.
- ⁇ ⁇ t ⁇ 0 t ⁇ 0 r e l - r ⁇ d B l , 1 d ⁇ r .
- ⁇ ⁇ ( t ) is function of B t ,1 , we kept the cross products as non necessarily zero terms.
- s ( t ) being the curvilinear abscissa representing the length of the arc represented by the track from a reference position to a current point.
- Equation (11) can be expressed in terms of ⁇ rather than ⁇ and observing that
- Second method ⁇ 2 Here, we observe a ratio between a normally distributed random variable and a folded normal distribution (the absolute value of a normally distributed random variable). In the case of a ratio between two independent, normally distributed random variables with zero mean, the distribution of the ratio follows a Cauchy distribution.
- One possibility is to exclude the samples of a CT ( t ),
- the area to exclude using a pretest should not be too large for one reason essentially: the exclusion reduces the availability of the test statistics (for each sample falling in the excluded area, the corresponding test statistics is set as unavailable). But the closer the exclusion bounds are to zero, the wider the distribution of the test statistics and therefore the smaller the minimum detectable curvature difference (MDCD).
- H a ⁇ T ⁇ ⁇ p K ⁇
- GNSS is not longer available, the velocity is drifting from its initial value considering a coasting using along track accelerometer.
- the localization problem consists of determining the track segment ID, the direction of displacement and the curvilinear abscissa on the track segment.
- a track segment is defined as a path between two switches.
- velocity fixes a coasting with the inertial unit based on along track, cross track accelerometers and a heading rate gyro using the characteristics defined in Table 2.
- the coasting time is not longer than 1 second when at least 5 satellites are visible which is generally the case. But in some cases (long tunnels or in the general case of bad satellite visibility or when the satellite signals are blocked or reflected by a strong multipath environment) the coasting time could be last much longer (up to several minutes).
- the error in the information is stationary and can be overbounded by a Gaussian distribution for a non zero required integrity risk. This overbound remains constant assuming the error is a stationary process.
- the MDCD is a function of the velocity of the train. Intuitively the larger the velocity of the train, the smaller the dispersion of the test statistic.
- the MDCD curves cross at a speed of approximately 50 [km/h]. This suggests a velocity based test selection: below 50 [km/h] we use ⁇ 2 to make our decision and above this limit, we use ⁇ 3 which performs better.
- a more efficient strategy could consist of defining a weighted combination of both test statistics enabling even lower MDCD. However, this is beyond the scope of this paper.
- the expectation and the variance of the Gaussian overbound of the sensor errors are analytically expressed and the test statistics after pretreatment of the random denominators (exclusion of an interval around zero to prevent heavy tailed distributions) are investigated using Monte Carlo simulations.
- the minimum detectable curvatures difference is determined for three different classes of IMUs, namely consumer, automotive and tactical grade.
- the resulting MDCD curves have been compared to standard curvatures and their performance have been assessed.
- ⁇ 1 in addition to being unavailable a large part of the time (exclusion of the high density around zero of the cross track acceleration) provides when a bad performance.
- ⁇ 2 and ⁇ 3 show best results with a maximum availability when the train is moving. A performance crossover can be observed for the consumer and automotive grade IMUs. That is ⁇ 3 can outperform ⁇ 2 when the velocity of the train is larger than 50 km/h.
- ⁇ 3 depends on the cross track acceleration which is difficult to sense in a more realistic dynamic scenarios (for a non-perfect horizontal plan of motion, for which the gravity vector may introduce a component in cross track direction).
- ⁇ 2 shows a real improvement as it can be reliably used for a large range of velocities. Furthermore, it has a dependency on the heading rate rather than on the accelerations which makes it more robust to realistic scenarios (non-perfect horizontal displacements).
- V ⁇ t ⁇ E ⁇ t ⁇ ⁇ 2
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Navigation (AREA)
Description
- The invention is related to a method for determining the track course of a track bound vehicle.
- A track bound vehicle can be for example a train or another vehicle in railroad traffic. Further, it can be any other vehicle which is bound to a track, meaning the vehicle is not able to leave this track under ordinary conditions.
- It is very important to be able to determine the track course of a track bound vehicle in a reliable manner, in particular when a train on a railroad track shall be localized. It is desirable to determine the position of the vehicle only by using sensors in or at the vehicle, so that no further infrastructure is needed.
- For this purpose, it is known to use inertial sensors. A drawback when using inertial sensors is that no method is known in order to determine the reliability of a determination of the position of the vehicle based on their function. For applications which are relevant to safety, for example in railroad traffic, this information is required.
- The publication "Multi-hypothesis Based Map-Matching Algorithm for Precise Train Positioning" by Gerlach and Rahmig in the proceedings of the 12th International Conference on Information Fusion (2009), pages 1363 - 1369, describes a multi-hypothesis based map-matching approach to fuse the data of a GPS receiver, a radar and an internal measurement unit.
- It is an object of the present invention to provide a method for determining the track course of a track bound vehicle, whereby the reliability of the determining of the track course can be specified.
- According to the invention this object is achieved by the features of
claim 1. - The inventive method for determining the track course of a track bound vehicle comprises the following method steps:
- a) A first error distribution of a curvature determination error for a plurality of erroneously measured track curvatures around a first estimated curvature value k̂ 1 is defined. This is due to the fact that for example if k̂ 1 is the actual curvature value, a sensor will also measure a plurality of false values which lie around the real value k̂ 1 when a plurality of measurements is conducted. Thereby, it is likely that values which are close to the real value k̂ 1 will be measured more frequently than more distant values (namely bigger errors). In the first error distribution the frequency of occurrence for each measuring error in the vicinity of k̂ 1 is shown.
- b) A first threshold T1 is defined according to a predefined first wrong decision probability, whereby any measured track curvature beyond this threshold is considered not to be the first estimated curvature value k̂ 1. The probability that the actual curvature value is k̂ 1 and lies beyond this first threshold T1 (meaning that the measured curvature value will erroneously be considered not to be k̂ 1) is defined as "probability of false alert (Pfa).
- c) A second error distribution of a curvature determination error for a plurality of erroneously measured track curvatures around a second estimated value k̂ 2 is defined. The first estimated curvature value k̂ 1 is smaller than k̂ 2.
- d) A second threshold T2 is defined according to a predefined second wrong decision probability, whereby any measured track curvature below this threshold is considered not to be the second estimated curvature value k̂ 2. The probability that the actual curvature value is k̂ 2 and lies below T2 (meaning that it will be erroneously considered not to be k̂ 2) is defined as "probability of misdetection" (Pmd). This is the probability that the actual curvature value is k̂ 2 but it was decided that it is another value.
- e) According to the invention the distance between k̂ 1 and k̂ 2 can be reliably specified when T1=T2 or T1<T2 is fulfilled. If the distance between k̂ 1 and k̂ 1 was chosen such that T1>T2, it would be impossible to decide if a measured curvature value lying between T2 and T1 (T2<measured value<T1) is k̂ 1 or k̂ 2.
- f) The track curvature of the track bound vehicle is measured by using at least one sensor. The measured curvature value is considered to be k̂ 1 if it is <T1 and is considered to be k̂ 2 if it is >T2, whereby if the measured value is identical to T2 and T1 the decision if it is T2 or T1 is taken based on a predefined system preference.
- The inventive method can be used for a plurality of applications which will be described in more detail later.
- The first and second wrong decision probability can be identical or differ from each other.
- It is preferred that the first and second error distribution in particular for each user sensor separately are determined each by a long time measurement in a static laboratory environment meaning that the conditions which might influence the function of the sensors are kept constant in this environment so that the exact error distribution of the sensor or sensors used can be determined. It is preferred that the first and the second error distribution are estimated.
- It is further preferred that under the precondition that the track can only have discrete predetermined curvatures in particular standard curvatures in railroad traffic, the quality of the performed curvature determination is determined in terms of a wrong decision probability. Standard curvatures in railroad traffic can be for example 0.4x10^(-3) l/m for a radius of 2.5km til 5.26x10^(-3) l/m for a radius of 190m.
- It is further preferred that a decision between the first estimated curvature k̂ 1 and the second estimated curvature value k̂ 2 is taken such that the value leading to the lowest wrong decision probability is chosen. The minimum distance between k1 and k2 is obtained such that the reliability requirements (Pfa and Pmd) are just fulfilled. That is for any k3>k2, the probability of miss-detection is smaller than the required on: Pmd(k3)<Pmd(k2)
- A further possible application of the inventive method is to determine a minimum difference between two standard curvatures which is required to be able to distinguish between them with a predefined wrong decision probability. For example it might follow from the inventive method that a minimum difference of 0.45x10-3 l/m is necessary in order to fulfill the predefined
wrong decision probability 10-5 at a velocity of 36.72km/h. The wrong decision probability can be a value between 10-4 and 10-6. - A further possible application of the inventive method is that a minimum speed can be specified for the vehicle for passing a switch which is required in order to be able to determine the correct function of the switch with a predefined wrong decision probability. When a train passes a switch, it is necessary to know reliably if the switch functions correctly, namely if the train took the desired direction. If the train moves too slowly the measuring error of the sensors will increase. Thus, there is a minimum speed with which the vehicle must move so that it is possible to determine if the vehicle took the desired direction with a predefined wrong decision probability. This minimum required speed can be determined with the inventive method.
- It is preferred that the track curvature of the track bound vehicle is measured by at least one sensor in or at the track bound vehicle. In particular, it is preferred that exclusively three inertial sensors are used, namely one lateral acceleration sensor, one longitudinal acceleration sensor and one rate sensor or gyroscope.
- The inventive method can be used as a subsidiary system which is part of an overall system (for example a system for localizing a vehicle in a map). In order to be able to specify the reliability or quality of the overall system it is necessary to specify first the reliability of the subsystem which can be done by the inventive method.
- In a preferred embodiment of the inventive method a curvature of the track course of the vehicle is determined. If this is done only in one snap-shot it is possible to reduce the number of possible positions of the vehicle in a map to all these positions which have the specified curvature. As an alternative it is possible to determine a plurality of subsequent curvatures, meaning that a plurality of curvatures of the vehicle is recorded over time. These recorded curvatures can be compared to the curvatures on a map so that it is possible to precisely identify the track course of the vehicle on the map.
- If the position of the vehicle is known (for example because no switches are on the track so that it has not to be decided whether the vehicle has taken the desired direction) the inventive method can be used in order to determine sensor errors, so that the sensor can be calibrated.
- In the following preferred embodiments of the invention are explained in the context of the figures.
- Fig. 1
- shows the first error distribution,
- Fig. 2
- shows the first error distribution with the first threshold T1,
- Fig. 3
- shows the first and second error distributions,
- Fig. 4
- shows minimum detectable curvature differences at different vehicle speeds,
- Fig. 5
- Display of the 2D curvilinear coordinate system to determine the track curvature,
- Fig. 6
- Curvature error distribution for different hypotheses,
- Fig. 7
- Test statistic for
curvature determination method 3 for two different hypothesis: In dark grey the true curvature 10-4 [m-1] and in light grey the true curvature is 1/1749 [m-1] which correspond to a minimum detectable curvature difference of MDCD=4.7176×10-4 [m-1] given a probability of wrong decision of Pwd =10-5, - Fig. 8
- Tracks configuration assumption,
- Fig. 9
- Minimum detectable curvature difference with respect to k0 = 10-4 [m-1] obtained for the three different curvature determination methods κ1, κ2 and κ3 vs. velocity are shown. For comparison, the standard German curvatures and their maximum allowed velocities are indicated by black lines. This plot is valid for a P wd = 10-5 and using consumer grade sensors,
- Fig. 10
- Minimum detectable curvature difference with respect to κ0 = 10-4 [m-1] obtained with the three different curvature determination methods κ1, κ2 and κ3 vs. velocity are shown. For comparison, the standard German curvatures and their maximum allowed velocities are indicated by black lines. This plot is valid for a P wd = 10-5 and using automotive grade sensors,
- Fig. 11
- Minimum detectable curvature difference with respect to κ0 = 10-4 [m-1] obtained with the three different curvature determination methods κ1, κ2 and κ3 vs. velocity are shown. For comparison, the standard German curvatures and their maximum allowed velocities are indicated by black lines. This plot is valid for a P wd = 10-5 and using tactical grade sensors,
- Fig. 12
- Availability degradation plot of curvature determination method κ1 vs. velocity. for different IMU grades.
- The track curvature is determined by using the above described sensors in particular based on three different methods which will be described later in more detail.
- As it is shown for example in
Fig. 10 each of these three curvature determination methods can result in a different minimum detectable curvature difference and a different vehicle speed dependency. For example, one method might result in lower required vehicle speeds which are necessary in order to be able to fulfill a required predefined wrong decision probability at different standard curvatures while another method might require higher speeds for the same preconditions. Since the performance order of the three methods is not constant over speed, it is preferred to switch between the three curvature determination methods depending on the speed and sensor quality. For example, if automotive grade sensors are used, it might be beneficial to usemethod 2 for 0-45km/h andmethod 3 for higher speeds (Figure 10 ). Thus, it is preferred to choose this curvature determination method for a first speed range which allows the vehicle to travel with lower speeds at given curvatures and wrong decision probabilities while a second (and possibly third) different curvature determination method is used for another speed range in which this other curvature determination method allows the vehicle to travel with lower speed in order to achieve the same results. - It is possible to use a weighted combination of the different curvature determination methods, whereby the weight of each method depends on the velocity of the vehicle. This is due to the fact that with changing velocity the quality of each method may change as described above. In the example given above the weight of one method is 0 whereas the weight of the second (better) method is 1 at a first speed range and vice versa at the second speed range. In the now described alternative it is possible to adapt the weight for each method depending on the velocity of the vehicle.
- It is further possible to adapt the weight of each method depending on the camber of a track (namely the rotation around an x-axis running parallel to the longitudinal direction of the vehicle). It is further possible to choose the weight of each method based on an ascending or descending slope of the track (namely a rotation around the y-axis of the vehicle).
- By using the inventive method it is not only possible to determine standard curvatures. It is also possible to determine the reliability of the curvature determination for arbitrary curvatures.
-
Fig. 1 shows qualitatively the expected error distribution pk (k̃) of a curvature determination error. The curvature k̂ is defined as multiplicative inverse of the track radius, i.e., k̂=1/r. This error distribution is centered around the true curvature value k̂. - The error distribution is used as an input for a threshold test, which for example can result in a minimum required curvature difference between two tracks. For this purpose a first threshold T1 is defined in the first error distribution (see
Fig. 2 ). A second threshold T2 is defined in the second error distribution (seeFig. 3 ). Since in the example shown inFigs. 2 and 3 T1=T2, only one threshold T=T1=T2 is shown. The probability of false alert is marked with Pfa inFig. 2 . The probability of misdetection is marked with Pmd inFig. 3 .Since both probabilities characterize the allowed decision error for either curvature one or two, they could be considered equal and can be called probability of wrong decision. - The minimum curvature difference, which can be detected while fulfilling the required safety aspects (namely wrong decision probabilities), results from the difference between the two estimated curvature values MDCD = k̂ 2 - k̂ 1 (minimum detectable curvature difference).
Fig. 4 shows some examples of these MDCD values, whereby three different curvature determination methods and inertial sensors of very high quality have been used. The curvature difference minima shown inFig. 4 have been calculated based on a wrong decision probability of 10-5 and tactical grade sensors. They are further dependent on the speed of the vehicle. The horizontal lines indicate the standard curvatures which are used in German railroad traffic (and their differences). The end of each of these horizontal lines indicates the maximum speed on these tracks. Therefore, the right, upper area shows vehicle speeds which are higher than the allowed German maximum speed on the respective track and hence, they are not relevant. - The inventive method can also be applied for determining the position of the vehicle in a three dimensional space. In this case additional sensors will be necessary since a three dimensional position cannot be determined by using the described three sensors.
- Further in the inventive method a more complex error model can be used for example by assuming that the bias of the sensors is defective meaning that it is not constant over a time. The same applies to the scale factor of the sensors.
- The inventive method including more detailed algorithms will now be described in more detail.
- First, a brief introduction is given:
- Global Navigation Satellite Systems (GNSS) are inspiring more and more safety of life applications like aviation, maritime and railway. However, for terrestrial applications in general and for rail applications especially, the signals provided by satellites are often blocked and reflected by surrounding obstacles like trees, terrain and buildings. So the signals coming to the receiving GNSS antenna might not be the direct signals but distorted ones. This has a huge impact on the achievable position accuracy, system availability, continuity and integrity. Consequently, pure satellite based navigation/localization systems may fail to provide the required system performance particularly for safety-of-life critical railway applications. Furthermore, GNSS is generally delivering an absolute positioning which is often not what matters in rail navigation. Here, trains can only move on well-defined smooth tracks and the localization objective consists of determining on which track segment and at which level in this segment the train is located and in which direction it moves. This information is crucial for collision avoidance system such as RCAS1. In case the position of the trains within the track map is reliably and continuously known, possible train collision situations can be identified and avoided on time.
- There are different approaches to solve this localization problem: The two main methods are map matching and dead reckoning system. The former obtains an absolute 3D position estimating using GNSS and additional sensors for each epoch and matches this position with the track map. This could be done by choosing the closest point in the track as the best estimate. In the second approach, the movement of the train relatively to a reference point is estimated incorporating all available sensors. Hence the position within the map is directly known. This approach can provide a more accurate and reliable solution since no intermediate solution is computed. Train localization/navigation using GNSS and IMU has been investigated by many different authors some of them providing novel and promising techniques using Bayesian filters [6].
- One of the most critical situations for dead reckoning systems are switches. Here, the train localization system needs to detect reliably and automatically with low latency which track was taken by the train. This decision can be done by determining the curvature of the track. In [1], low-cost MEMS gyroscopes are used for curvature detection. By applying a matched filter, the detection is optimized for real-time operations. However, the reliability of the detection cannot be determined which is mandatory for integrity assessment.
- In this paper, we define and investigate the usage of three different test statistics to classify the curvature of the track instantaneously. We also address the performance of this classification with respect the false alert and miss-detection probabilities. Based on these results, we determine the minimum velocity which is necessary to reliably identify the curvature. In our approach, we use three inertial sensor components, i.e., an along-track and a cross-track accelerometer and a heading rate gyroscope. As a matter of course, the classification performance depends strongly on the quality of the sensor. Hence, we discuss the sensor error model, derive the corresponding stochastic differential equation and the Gaussian overbound of the stochastic process solution. We then outline and analyze the three possible curvature computation methods expressed as ratios of sensor outputs. Later the resulting test statistics of these three methods are evaluated with respect to standard German track curvatures. Finally, we conclude this paper with a summary and a direction for future work.
- In this paragraph we list the major assumptions that we make except those related to the error model extensively discussed in the following section.
- We neglect the effect of the gravity related errors in the inertial sensors. That is we assume that the plan of motion (formed by the along track and cross track vectors) is perpendicular to the gravity vector. Hence, the acceleration due to the gravity is not measured by the along and cross track sensors. This assumption might be valid due to the planar construction requirement of switches in general.
- We assume that the accelerometers are perfectly aligned with the body frame of the train. Hence, no along track and cross track misalignment are considered.
- For the heading rate gyroscope, we further assume a perfectly alignment of the motion plan. We further assume a perfect correction of the turn rate errors due to the Coriolis force and the earth rotation.
- Inertial error models have been widely discussed in the literature. According to [2], however it is sufficient to use a simplified version of sensor model. Assuming the misalignment of the different sensors with respect to the reference axes are known, the measured sensor output can be written as:
where m̂(t) is the measured sensor output such as angular turn rate and a 1-D acceleration, respectively. The true value of this quantity is denoted as m(t) and can be used as the input value in the simulations. It is possible to simulate different type of scenarios as for example vibrations or constant acceleration, deceleration [5]. An ideal accelerometer would directly sense m(t) but in a non ideal case, the measured acceleration or turn rate is decomposed into a proportional part (proportional to a scaling factor sf ) and a time dependent drift part b(t). The latter can be modeled by a constant offset b 0 as well as a time varying b 1(t) and a sampling noise component η m : [0040] - We assume that the offset b 0 stays constant during each run and is corrected by an initial calibration of the sensors. Additionally, the sampling noise is assumed to be Gaussian distributed with zero-mean and a
variance
where τ is the correlation time and η b is the driving noise which can be assumed to be Gaussian distributed with zero mean andvariance - In order to obtain realistic values for the sampling and driving noise component as well as for the time correlation, real sensor measurements have to be analyzed with the help of the Allan variance and auto-correlation function of a long series of zero-input measurements [2]. Exemplary, we show the resulting parameters of three different qualities of inertial sensors in Table 2. We will use these parameters and values throughout our paper.
- Due to the focus of this paper, we need to investigate not only the error of the measurement itself but also its propagation via integration. In the following, we look into the stochastic differential equation issues to solve our problem.
- Let us first consider a one dimensional translational acceleration (without attitude change) only. The position of the rover can be determined using only one accelerometer or the combination of redundant accelerometers in the direction of the acceleration. We combine the Equation (1) and (2) and obtain:
-
-
-
- These equations can be applied to all our measurements required for our test statistics, i.e., to the cross track and along track accelerometer as well as to the heading rate gyroscope.
-
- In general, two different approaches are used to solve these kind of problems. The first one uses a generator of the Ito-diffusion process defined by the stochastic differential equation and derive a partial differential equation, so called Kolmogorov Forward Equation or Fokker Planck Equation. Its solution is a transition probability density function of the solution process (see [4] and [3]).
- The second method takes advantage of the fact that the process solution is Gaussian distributed, if the initial state densities can be assumed to be also Gaussian distributed. Hence, it is sufficient to investigate the evolution of the corresponding expectation and variance of the transition density function. In the section below, we apply the second concept and discuss the results.
- We consider a state vector comprising the drift of the sensor and the integral with respect to time of the sensor error (e.g., the velocity error for an accelerometer or the heading error for an angle rate gyro). So we need to solve this problem:
where x (0) = (b 1(0) u(0)) T is our initial state vector. Recall from before that this can be considered as an Ornstein-Uhlenbeck process in case of a continuous time problem or as an 1st-order auto-regressive process with equilibrium at 0 in case of a discrete time problem. Thus, we can reformulate Equation (6) as integrated process: - Under the assumption that the initial value of the time-variant bias b 1(0) can be considered as normal distributed random variable with mean
- Similar steps, we can apply to the full stochastic differential equation x (t) = (b 1(t) u(t)) T and we obtain:
where -
-
-
-
- We observe that when the random variables in the model of the sensor are all Gaussian distributed (including the initial point b 1(0) and u0, the state vector is also Gaussian distributed. Therefore the propagation of the mean and the variance is sufficient if we want to characterize the whole distribution.
-
-
- In the following section, the physical assessment of the track curvature is introduced and three different methods are outlined. Let s(t) being the curvilinear abscissa representing the length of the arc represented by the track from a reference position to a current point. The velocity vector of the train is v = ṡ e AT and the acceleration vector is:
- In this expression and in the rest of this chapter we drop the time t for simplification. The dot above variables always means the derivative of the given variable with respect to time. To express ė AT , we use the notations of
Figure 5 . During dt, the point M moved from s to s+ds and the unit along track vector has rotated with the angle dψ. This drives to the following relation: -
-
-
- There is a relation between the speed of the train, the cross track acceleration and the heading rate for a given trajectory.
-
- In this equation, we can directly sense the cross track acceleration aCT, the heading rate ψ̇ and indirectly the velocity of the train v (integral of the along track acceleration). This is an important a-priori information that can be used in a test statistic to decide which direction the train has taken after a switch. By convention we will choose to work with the curvature rather than with r. Let κ = 1/r the relation above can be written as follows:
-
- All three methods can also be used in a non-stationary scenario, i.e., while the train is moving. Otherwise the curvature determination might be not defined. That is if aCT = 0, κ1 is undefined and if ||v(t)|| = 0, κ2 and κ3 are undefined.
- In this section, we analyze the resulting test statistic based on the three curvature determination methods. To compute κi, i = 1, ... , 3, we need the heading rate, along-track and cross-track accelerations. These measurements are distorted by sensor errors which can be modeled as described in Section I-B. Using the SDE results from Section I-C, we can access the error distribution of each measurement required to determine the curvature. However, the distribution of curvatures itself is not simple to derive since we have to obtain the distribution of a ration of random variables. The resulting distribution might not be symmetric and can be even heavy tailed. In the following, we discuss the expected behavior of the test statistics.
- Naturally, if all measurements would be error-free, all three curvature computations would deliver the same result κ1 = κ2 = κ3. But due to the randomness of the measurements of aCT (t), ψ̇(t) and v(t), the performance of the obtained curvatures can only be characterized in terms of distribution.
- First method κ1: The measurements of this methods can be directly sensed, so no integration of the measurements is required. However, we can see that if the curvature of the path is zero, i.e., the track is straight, the numerator will take positive random values following a χ2 distribution and the denominator will take values centered at 0. This induces fat tails in the distribution of κ1. Consequently, it might be not very promising to use this method for the hypothesis test.
- Second method κ2: Here, we observe a ratio between a normally distributed random variable and a folded normal distribution (the absolute value of a normally distributed random variable). In the case of a ratio between two independent, normally distributed random variables with zero mean, the distribution of the ratio follows a Cauchy distribution. In the case of non-centered distributions, it has been demonstrated [7] that the probability density function can be written as follows:
where - Third method κ3: Similar to κ2, to nominator can be seen as normal distributed random variable. However, the denominator is not only linear dependent on an folded normal distributed random variable, but quadratically dependent. Also in this case no close for solution can be found.
- In the remaining paper, we assess the distributions of κ i , i = 1,...,3 via Monte-Carlo simulations. As derived before we can compute the probability distributions of aCT (t), ψ̇(t) and v(t) depending on the quality of the sensor as well as initialization. Please note that the direct use of heavy tailed distributions can generate instabilities of the test statistics. In this case, the mean and variance may not exist especially in the case of high densities around zero for the test statistics denominators.
- One possibility is to exclude the samples of aCT (t), ||v(t)|| and ||v(t)||2 that are close to zero, or in an interval around zero. The area to exclude using a pretest should not be too large for one reason essentially: the exclusion reduces the availability of the test statistics (for each sample falling in the excluded area, the corresponding test statistics is set as unavailable). But the closer the exclusion bounds are to zero, the wider the distribution of the test statistics and therefore the smaller the minimum detectable curvature difference (MDCD).
- To classify or identify a certain curvature, we compare our computed curvature with a threshold. The latter, we have determined by a standard hypothesis test algorithm. In the following, this algorithm is described briefly.
- First of all, reliable knowledge of curvature determination error behavior is required. We denoted this curvature error probability density function as pK (κ). We assume that this pdf is centered at the true curvature. Then we can define the distributions for two different track curvature hypotheses that we want to test. For example, after a switch a train might have two possibilities to move on, i.e., track segment one with curvature κ a or track segment two with curvature κ b .
Figure6 (a) illustrates the resulting curvature pdfs, if either track segment one pK (κ|Ha ) or track segment two pK (κ|Hb ) has been taken. In order to make a decision, we have to define a threshold T against which we compare our curvature measurements. If our measurement is below the obtained threshold, we decide for Ha and if it exceeds this threshold, we decide for Hb. To find this threshold we have to consider the probability of false alarm P fa. This probability is a system reliability requirement and accounts for the case, where we decided for Hb (indicated segment two, while hypothesis Ha was correct (the train took the segment one). This is depicted onFigure 6 (b) ). Consequently, the threshold is given by -
- This is displayed in
Figure 6 (c) . P md is also a system reliability requirement and normally pre-defined by the system. So for a given P md, we can find a κ m such that
where Hm is the hypothesis that the train has taken a track with curvature κ m . Thus, we can define a minimum detectable curvature difference MDCD = κm - κ a for the given system requirements of false alert and missed detection. Both probabilities, P md and P fa indicate that a wrong decision is made. Since we want to protected hypothesis Ha and Hb equally, we set P fa = P md = P wd, where wd stands for wrong decision. - In
Figure (7 ), we show two histograms observed while using the test statistics of κ3. The train moves with a speed of 50 [km/h] and the coasting time is 75 seconds. By coasting time we understand the time for which the inertial sensors run free, so the time after initialization. We assume that during the coasting period, the speed is obtained by integrating the along track acceleration. In dark gray, we show the distribution of the test statistic under the hypothesis Ha (with a curvature radius of 10 km) and the light gray curve corresponds to the hypothesis Hb (with a curvature radius of 1749 m). So the minimum detectable curvature difference is equivalent to MDCD = 1/1749 - 10-4 = 4.7176 × 10-04 [m-1]. The probability of wrong detection is set to P wd = 10-5 and is generally a requirement based on the level of hazard for being on another track than the one expected. This risk is usually defined as a probability of being in this hazardous situation during a predefined exposure time. - For simulation, we used standard curvatures found in the German railway. A summary of available curvatures and corresponding maximum allowed train velocity can be found in Table 1. As mentioned before, the error model parameters of the used inertial sensors are shown in Table 2.
Table 1: Basic Design Parameters of German standard switches [8] radius r in m curvature c in 10-3 1/m max velocity v max in km/h 190 5.26 40 300 3.33 50 500 2.0 60 760 1.32 80 1200 0.83 100 2500 0.4 120 - We propose to investigate a curvature detector based on the three test statistics defined in Equations (15, 16, 17). The path identification after a switch is crucial for train surveillance and train collision avoidance systems. If we assume not to know the itinerary but just the map with the switch locations and the curvature of the possible paths after the switches, it is possible to determine the path followed by the train with a confidence depending on the quality of the sensors.
- In the simulations, we use a sensor having the following characteristics:
- We solve the stochastic differential system for the expectation and the variance for all three different sensor grades.
- We draw paths following the process distributions calculated and we build the histograms for each test statistic κ1, κ2 and κ3.
-
- At a given initial epoch we assume to know the position and the direction of displacement of the train (for example at the departure station). The localization problem consists of determining the track segment ID, the direction of displacement and the curvilinear abscissa on the track segment.
- A track segment is defined as a path between two switches. We assume that between two guaranteed positions (e.g., obtained by GNSS and verified by a receiver autonomous integrity monitoring), velocity fixes a coasting with the inertial unit based on along track, cross track accelerometers and a heading rate gyro using the characteristics defined in Table 2. The coasting time is not longer than 1 second when at least 5 satellites are visible which is generally the case. But in some cases (long tunnels or in the general case of bad satellite visibility or when the satellite signals are blocked or reflected by a strong multipath environment) the coasting time could be last much longer (up to several minutes). Nevertheless, as long as the information used is not integrated in the time to obtain velocity, position or heading angle, the error in the information is stationary and can be overbounded by a Gaussian distribution for a non zero required integrity risk. This overbound remains constant assuming the error is a stationary process.
- In
Figure (8 ) we show the topology we adopt for the switch scenario. We assume at each switch, only two possible tracks can be taken. - We have seen in the precedent section that the probability of wrong decision is an important system reliability requirement. The question we need to answer is now: What is the minimum curvature difference for which we can detect an alternative curvature with a probability of 1 - P WD? In order to answer this question, we first have to determine our test statistic threshold T = fct(κ0, P WD) which is a function of the curvature of our Ha hypothesis κ0 and the allowed probability of false alert. Then we generate the probability density function for a continuously growing curvature κ m > κ0 until we get:
where Hm is the hypothesis centered at κ m and κ i , for i = 1,...,3 are the different test statistics defined in Equation (15, 16,17). Finally, the MDCD is κ m - κ0. - The MDCD is a function of the velocity of the train. Intuitively the larger the velocity of the train, the smaller the dispersion of the test statistic.
- We investigate the MDCD for each test statistic as function of the train velocity at a switch and for different IMU qualities. In the following investigations, we set our curvature of hypothesis Ha to κ0 = 10-4 [m-1].
- In
Figures (9 ,10 ,11 ) we have plotted the corresponding MDCD vs. the velocity for each test statistic and for each IMU quality. The black horizontal lines represent the standard curvatures of tracks observed in Germany. Each standard line starts at ν = 0 [km/h] and stop at the maximal allowed velocity for the corresponding curvature. The larger the curvature, the smaller the maximal allowable speed. The initial and reference curvature to be almost zero (a curvature of exactly 0 lends to a singularity). We see that the lower the velocity, the higher the MDCD. - Although κ1 seems to provide acceptable performance in the case of tactical grade IMU, its low availability for a large range of velocities see
Figure (12 ) makes it unusable for the simulated scenario. Only κ2 and κ3 are providing acceptable results (their availabilities were always 100% for any type of IMU). - For tactical grade IMU, we see a very effective κ2 based test statistic. In fact the combination of high accurate velocity and high performance heading gyro provides a sharp distribution and therefore a clear signature when the train change its track. For this tactical grade IMU, κ2 and κ3 are not crossing in the velocity range [0 - 200] [km/h].
- For both the consumer and the automotive grade IMUs, the MDCD curves cross at a speed of approximately 50 [km/h]. This suggests a velocity based test selection: below 50 [km/h] we use κ2 to make our decision and above this limit, we use κ3 which performs better. A more efficient strategy could consist of defining a weighted combination of both test statistics enabling even lower MDCD. However, this is beyond the scope of this paper.
- The results obtained suggest a weighted sum of κ2 and κ3 in order to improve the detectability. Some intrinsic problems may appear because of the dependency of all 3 test statistics. Correlations need to be considered while seeking an optimal combination of curvature types.
- In this paper we explored three different ways to determine track curvatures. The tests are based on ratios of random variables that can be directly sensed like the heading rate gyro and the cross track acceleration and indirectly sensed like the speed of the train which can be obtained by an integration of the along track acceleration.
- The expectation and the variance of the Gaussian overbound of the sensor errors are analytically expressed and the test statistics after pretreatment of the random denominators (exclusion of an interval around zero to prevent heavy tailed distributions) are investigated using Monte Carlo simulations. The minimum detectable curvatures difference is determined for three different classes of IMUs, namely consumer, automotive and tactical grade. The resulting MDCD curves have been compared to standard curvatures and their performance have been assessed.
- It is shown that κ1 in addition to being unavailable a large part of the time (exclusion of the high density around zero of the cross track acceleration) provides when a bad performance. In comparison, κ2 and κ3 show best results with a maximum availability when the train is moving. A performance crossover can be observed for the consumer and automotive grade IMUs. That is κ3 can outperform κ2 when the velocity of the train is larger than 50 km/h. However, κ3 depends on the cross track acceleration which is difficult to sense in a more realistic dynamic scenarios (for a non-perfect horizontal plan of motion, for which the gravity vector may introduce a component in cross track direction). In contrast, κ2 shows a real improvement as it can be reliably used for a large range of velocities. Furthermore, it has a dependency on the heading rate rather than on the accelerations which makes it more robust to realistic scenarios (non-perfect horizontal displacements).
- Future studies will consider a generalization of this concept for a three dimensional tracks (with gravity vector not always perpendicular to the motion plan), misalignment of sensors, transition curvatures. The performance crossover observed for κ2 and κ3 for low cost IMUs suggests to use a combination of both test statistics which is investigated in a future paper. Another investigation might consider the minimum probability of wrong detection for a given type of IMU and as function of the speed at the switch. This approach can give the level of safety achieved by different types of IMU.
- Consider the following Brownian Motion:
-
-
-
-
-
-
-
-
-
- [1] Antoni Broquetas, Adolf Comerón, Antoni Gelonch, Josep M. Fuertes, J. Antonio Castro, Damià Felip, Miguel A. López, and José A. Pulido. Track Detection in Railway Sidings Based on MEMS Gyroscope Sensors. Sensors, 12(12):16228-16249, 2012.
- [2] Demoz Gebre-Egziabher. Design and Performance Analysis of a Low-Cost Aided Dead Reckoning Navigator. PhD thesis, Stanford University, 2004.
- [3] Anja Grosch and Boubeker Belabbas. Parameter Study of Loosely Coupled INS/GNSS Integrity Performance. In Proceedings of IEEE/ION PLANS, Myrtle Beach, SC, USA, 24-26 Apr 2012 2012.
- [4] Anja Grosch, Boubeker Belabbas, and Michael Meurer. Redundant Inertial-Aided GBAS for Civil Aviation. In European Space Research and Technology Centre (ESTEC), editors, Navitec 2010, Noordwijk, The Netherlands, 08.-10. Dez. 2010 2010.
- [5] Oliver Heirich, Andreas Lehner, Patrick Robertson, and Thomas Strang. Measurement and Analysis of Train Motion and Railway Track Characteristics with Inertial Sensors. In Intelligent Transportation Systems Conference (ITSC), Washington, USA, 2011.
- [6] Oliver Heirich, Patrick Robertson, Adrian Cardalda Garcia, and Thomas Strang. Bayesian Train Localization Method Extended By 3D Geometric Railway Track Observations From Inertial Sensors. In 15th International Conference on Information Fusion, Singapore, 9.-12. Jul. 2012 2012. International Society of Information Fusion (ISIF).
- [7] D. V. Hinkley. On the Ratio of Two Correlated Normal Random Variables. Biometrika, Vol. 56, No. 3:635-639, 1969.
- [8] H. Jochim and F. Lademann. Planung von Bahnanlagen. Carl Hanser Verlag München, Germany, 2009.
- [9] Bernt Oksendal. Stochastic Differential Equations Sixth Edition. Number ISBN 978-3-540-04758-2. Springer, 6 edition, 2007.
Claims (8)
- Method for determining the track course of a track bound vehicle,
the method comprising the following steps:a) defining a first error distribution of a curvature determination error for a plurality of erroneously measured track curvatures around a first estimated curvature value k̂ 1,b) defining a first threshold T1 according to a predefined first wrong decision probability, whereby any measured track curvature beyond this threshold is classified not to be the first estimated curvature value k̂ 1,c) defining a second error distribution of a curvature determination error for a plurality of erroneously measured track curvatures around a second estimated curvature value k̂ 2, the first estimated curvature value k̂ 1 being smaller than the second estimated curvature value k̂ 2,d) defining a second threshold T2 according to a predefined second wrong decision probability, whereby any measured track curvature below this threshold is classified not to be the second estimated curvature value k̂ 2, the second threshold T2 being located on this end of the second error distribution facing towards the first error distribution,e) whereby the distance between the first and second estimated curvature values k̂ 1 and k̂ 2 can be reliably specified when T1 = T2 or T1<T2 is fulfilledf) measuring a track curvature of the track bound vehicle, whereby the measured curvature value is considered to be k̂ 1 if it is <T1 and is considered to be k̂ 2 if it is >T2, whereby if the measured value is identical to T1 and T2 the decision if it is T1 or T2 is taken based on a predefined system preference. - Method according to claim 1, characterized in that the first and second error distribution are determined each by a long time measurement in a static laboratory environment, in particular a zero-input long term measurement, which is used to determine the required error parameters.
- Method according to claims 1 or 2, characterized in that under the precondition that the track can only have discrete predetermined curvatures, in particular standard curvatures in railroad traffic, the quality of the performed curvature determination is determined in terms of a wrong decision probability, sensor quality and speed of the vehicle.
- Method according to claims 1 to 3, characterized in that a decision between the first estimated curvature value k̂ 1 and the second estimated curvature value k̂ 2 is taken such that the value leading to the lowest wrong decision probability is chosen.
- Method according to claims 1 to 4, characterized in that a minimum difference between two curvatures is determined such that this decision fulfills predefined reliability requirements, e.g. probability of wrong decision.
- Method according to claims 1 to 5, characterized in that a minimum speed is determined for the vehicle for passing a switch which is required in order to be able to determine the correct function of the switch with a predefined wrong decision probability.
- Method according to claims 1 to 6, characterized in that the track curvature of the track bound vehicle is measured by at least two sensors in or at the track bound vehicle, in particular by exclusively three inertial sensors, namely one lateral acceleration sensor, one longitudinal acceleration sensor and one rate sensor or gyroscope.
- Method according to claims 1 to 7, characterized in that when the curvature of the track is known the inventive method is used in order to determine sensor errors and subsequently calibrate the sensors.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP13164791.9A EP2796337B1 (en) | 2013-04-22 | 2013-04-22 | Method for determining the track course of a track bound vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP13164791.9A EP2796337B1 (en) | 2013-04-22 | 2013-04-22 | Method for determining the track course of a track bound vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
EP2796337A1 EP2796337A1 (en) | 2014-10-29 |
EP2796337B1 true EP2796337B1 (en) | 2015-12-09 |
Family
ID=48184080
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP13164791.9A Active EP2796337B1 (en) | 2013-04-22 | 2013-04-22 | Method for determining the track course of a track bound vehicle |
Country Status (1)
Country | Link |
---|---|
EP (1) | EP2796337B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107664994A (en) * | 2016-07-29 | 2018-02-06 | 通用汽车环球科技运作有限责任公司 | Merge the system and method for management for autonomous driving |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102016208675A1 (en) * | 2016-05-19 | 2017-11-23 | Lucas Automotive Gmbh | Method for determining a safe speed at a future waypoint |
EP3499271A1 (en) * | 2017-12-18 | 2019-06-19 | Siemens Aktiengesellschaft | Determination of a position of a vehicle |
CN111854776B (en) * | 2019-04-30 | 2024-04-16 | 北京京东乾石科技有限公司 | Navigation processing method, device, equipment and storage medium |
CN111866709B (en) * | 2020-06-29 | 2022-05-17 | 重庆邮电大学 | Indoor Wi-Fi positioning error bound estimation method for moving target |
CN112531683A (en) * | 2020-11-19 | 2021-03-19 | 国网湖北省电力有限公司电力科学研究院 | Distribution network line load prediction method based on solution of Ornstein-Urnbek process |
CN116828398B (en) * | 2023-08-29 | 2023-11-28 | 中国信息通信研究院 | Tracking behavior recognition method and device, electronic equipment and storage medium |
-
2013
- 2013-04-22 EP EP13164791.9A patent/EP2796337B1/en active Active
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107664994A (en) * | 2016-07-29 | 2018-02-06 | 通用汽车环球科技运作有限责任公司 | Merge the system and method for management for autonomous driving |
Also Published As
Publication number | Publication date |
---|---|
EP2796337A1 (en) | 2014-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2796337B1 (en) | Method for determining the track course of a track bound vehicle | |
EP3605504A1 (en) | Determination device, determination method, and program | |
CN107449443B (en) | Integrity monitoring of radar altimeter | |
EP2784445B1 (en) | Selected aspects of advanced receiver autonomous integrity monitoring application to kalman filter based navigation filter | |
EP2664894B1 (en) | Navigation apparatus | |
Jing et al. | Integrity monitoring of GNSS/INS based positioning systems for autonomous vehicles: State-of-the-art and open challenges | |
US20210215503A1 (en) | Method for controlling a vehicle system of a vehicle equipped for carrying out an automated driving operation and device for carrying out the method | |
CN112204346B (en) | Method for determining the position of a vehicle | |
Huang et al. | Design of a fault detection and isolation system for intelligent vehicle navigation system | |
JP2015083930A (en) | Navigation device and method for determining elevated road and under elevated road | |
US10571281B2 (en) | Information processing apparatus and method | |
CN112406965B (en) | Method and system for improving train positioning safety | |
Suganuma et al. | Localization for autonomous vehicle on urban roads | |
Zinoune et al. | Sequential FDIA for autonomous integrity monitoring of navigation maps on board vehicles | |
Jacob et al. | Vehicle trajectory analysis: an advanced tool for road safety | |
Malvezzi et al. | Train position and speed estimation by integration of odometers and IMUs | |
Rojas et al. | Quantitative resilience assessment of GPS, IMU, and LiDAR sensor fusion for vehicle localization using resilience engineering theory | |
Zinoune et al. | A sequential test for autonomous localisation of map errors for driving assistance systems | |
Palmer et al. | Robust odometry using sensor consensus analysis | |
Herencia-Zapana et al. | Formal verification of safety buffers for sate-based conflict detection and resolution | |
EP3605498A1 (en) | Output device, control method, program, and storage medium | |
No et al. | Diagnostics of GNSS-based Virtual Balise in railway using embedded odometry and track geometry | |
Barrios et al. | Predicting vehicle trajectory | |
RU2668597C1 (en) | Method of troubleshooting and failures of aircraft measurement parameters of movement and satellite navigation systems of moving objects | |
Dean et al. | Highway evaluation of terrain-aided localization using particle filters |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
17P | Request for examination filed |
Effective date: 20140331 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
AX | Request for extension of the european patent |
Extension state: BA ME |
|
GRAP | Despatch of communication of intention to grant a patent |
Free format text: ORIGINAL CODE: EPIDOSNIGR1 |
|
INTG | Intention to grant announced |
Effective date: 20150617 |
|
GRAS | Grant fee paid |
Free format text: ORIGINAL CODE: EPIDOSNIGR3 |
|
GRAA | (expected) grant |
Free format text: ORIGINAL CODE: 0009210 |
|
AK | Designated contracting states |
Kind code of ref document: B1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
REG | Reference to a national code |
Ref country code: GB Ref legal event code: FG4D |
|
REG | Reference to a national code |
Ref country code: AT Ref legal event code: REF Ref document number: 764435 Country of ref document: AT Kind code of ref document: T Effective date: 20151215 Ref country code: CH Ref legal event code: EP |
|
REG | Reference to a national code |
Ref country code: IE Ref legal event code: FG4D |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R096 Ref document number: 602013004070 Country of ref document: DE |
|
REG | Reference to a national code |
Ref country code: FR Ref legal event code: PLFP Year of fee payment: 4 |
|
REG | Reference to a national code |
Ref country code: LT Ref legal event code: MG4D |
|
REG | Reference to a national code |
Ref country code: NL Ref legal event code: MP Effective date: 20151209 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: ES Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: NO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20160309 Ref country code: LT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
REG | Reference to a national code |
Ref country code: AT Ref legal event code: MK05 Ref document number: 764435 Country of ref document: AT Kind code of ref document: T Effective date: 20151209 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: GR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20160310 Ref country code: FI Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: SE Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: NL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: LV Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: RS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: CZ Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: IT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: AT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: SK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: IS Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20160409 Ref country code: PT Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20160411 Ref country code: BE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20160430 Ref country code: RO Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: SM Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: EE Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R097 Ref document number: 602013004070 Country of ref document: DE |
|
PLBE | No opposition filed within time limit |
Free format text: ORIGINAL CODE: 0009261 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: NO OPPOSITION FILED WITHIN TIME LIMIT |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: PL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: DK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
26N | No opposition filed |
Effective date: 20160912 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: SI Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
REG | Reference to a national code |
Ref country code: CH Ref legal event code: PL |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: BE Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: LU Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20160422 |
|
REG | Reference to a national code |
Ref country code: IE Ref legal event code: MM4A |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: LI Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20160430 Ref country code: CH Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20160430 |
|
REG | Reference to a national code |
Ref country code: FR Ref legal event code: PLFP Year of fee payment: 5 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: IE Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20160422 |
|
GBPC | Gb: european patent ceased through non-payment of renewal fee |
Effective date: 20170422 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: GB Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20170422 |
|
REG | Reference to a national code |
Ref country code: FR Ref legal event code: PLFP Year of fee payment: 6 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: HU Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT; INVALID AB INITIO Effective date: 20130422 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: MK Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: MC Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: HR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: CY Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: MT Free format text: LAPSE BECAUSE OF NON-PAYMENT OF DUE FEES Effective date: 20160430 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: BG Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
PG25 | Lapsed in a contracting state [announced via postgrant information from national office to epo] |
Ref country code: AL Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 Ref country code: TR Free format text: LAPSE BECAUSE OF FAILURE TO SUBMIT A TRANSLATION OF THE DESCRIPTION OR TO PAY THE FEE WITHIN THE PRESCRIBED TIME-LIMIT Effective date: 20151209 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: FR Payment date: 20230320 Year of fee payment: 11 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: DE Payment date: 20230320 Year of fee payment: 11 |