Method for determining the direction of travel of a vehicle
A method for determining the direction of travel of a vehicle comprises providing a first sensor for measuring a longitudinal acceleration of the vehicle and at least one second sensor for establishing the rotational movement of a wheel of the vehicle, An acceleration signal containing acceleration information from the first sensor is received by the system. The acceleration signal is filtered resulting in a modified acceleration signal. The direction of travel of the vehicle is determined based on the modified acceleration signal and based on the output signal of the second sensor.
1. A method of determining a direction of travel of a vehicle, the method comprising:
measuring a longitudinal acceleration of the vehicle based on an acceleration signal of a first sensor configured to measure the longitudinal acceleration of the vehicle;
detecting that the vehicle starts to move from a standstill or changes direction based on rotational movement of a wheel of the vehicle indicated by a first ascending edge or a first descending edge of a time dependent output signal of a second sensor configured to determine rotational movement of the wheel;
filtering the acceleration signal resulting in a modified acceleration signal, the filtering including band-stop filtering the acceleration signal to filter out oscillations of the vehicle from the acceleration signal, and lowpass filtering of the band-stop filtered acceleration signal;
determining the direction of travel of the vehicle based on a difference between the modified acceleration signal and one of the acceleration signal or the band-stop filtered acceleration signal immediately after either the vehicle starts to move from a standstill or changes direction based on the time dependent output signal of the second sensor; and
autonomously controlling driving of the vehicle based on the direction of travel,
wherein determining the direction of travel of the vehicle is based on the difference between the modified acceleration signal and the acceleration signal.
2. The method according to claim 1 , wherein determining the direction of travel comprises:
determining the direction based on a sign of the difference.
3. The method according to claim 1 , wherein the band-stop filtering filters out a frequency band which comprises a frequency of the oscillations of the vehicle following deceleration or acceleration of the vehicle.
4. The method according to claim 1 , wherein the band-stop filtering has a transfer function inverse to a mass-spring-damper model of the vehicle.
5. The method according to claim 4 , wherein the band-stop filtering has a transfer function as follows:
G
=
a
2
s
2
+
a
1
s
+
a
0
b
1
s
+
b
0
·
1
T
a
d
d
2
+
2
T
a
d
d
S
+
1
;
and wherein the following applies:
a
2
=
1
ω
0
2
;
a
1
=
2
D
ω
0
;
a
0
=
1
;
b
1
=
2
D
ω
0
;
b
0
=
1
;
wherein G is the transfer function, a x and b x are general coefficients, ω 0 is a resonant circuit frequency, Tada is a circulation time, s=is a path length, and D is a damping degree.
6. The method according to claim 5 , wherein the parameters are selected as follows:
D= 0.2;
ω 0 =2*π*2.5 Hz; and
T add =0.04 s.
7. A system for determining a direction of travel of a vehicle, the system comprising:
a first sensor configured to measure a longitudinal acceleration of the vehicle;
a second sensor configured to detect rotational movement of a wheel of the vehicle,
a processor configured to receive an acceleration signal of the vehicle from the first sensor, filter the acceleration signal resulting in a modified acceleration signal by band-stop filtering the acceleration signal to filter out oscillations of the vehicle from the acceleration signal to generate a band-stop filtered acceleration signal, and by lowpass filtering of the band-stop filtered acceleration signal, detect that the vehicle starts to move from a standstill or changes direction based on the rotational movement of the wheel of the vehicle indicated by a first ascending edge or a first descending edge of a time dependent output signal from the second sensor, determine the direction of travel of the vehicle based on a difference between the modified acceleration signal and one of the acceleration signal or the band-stop filtered acceleration signal, the direction of travel being determined immediately after either the vehicle starts to move from a standstill or changes direction based on the time dependent output signal of the second sensor, and autonomously control driving of the vehicle based on the direction of travel,
wherein determining the direction of travel of the vehicle is based on the difference between the modified acceleration signal and the acceleration signal.
8. The system according to claim 7 , wherein where the processor is configured to determine the direction based on a sign of the difference.
9. The method according to claim 1 , further comprising temporarily deactivating the lowpass filtering depending upon a speed of the vehicle or a driving parameter of the vehicle or of another vehicle.
10. The system according to claim 7 , wherein the processor is further configured to temporarily deactivate the lowpass filtering depending upon a speed of the vehicle or a driving parameter of the vehicle or of another vehicle.
11. The method of claim 1 , wherein the lowpass filtering filters out distortions of the acceleration signal from an inclination of the vehicle.
12. The system according to claim 7 , wherein the lowpass filter filters out distortions of the acceleration signal from an inclination of the vehicle.