Low-speed maneuvering assistant for a vehicle
A maneuvering assistant system for a vehicle combination comprising an interface configured to receive measurements from a camera, processing circuitry implementing a Kalman filter configured to observe an articulation angle of the vehicle combination on the basis of the measurements from the camera, a signal analyzer configured to repeatedly estimate a signal noise of the camera measurement and to adjust the Kalman filter on the basis of statistics derived from the estimated signal noise, and an assistance unit configured to receive an estimate of the articulation angle from the Kalman filter and provide drive actions based on the estimate.
1. A method for assisting maneuvering of a vehicle combination, comprising:
initiating a Kalman filter which observes an articulation angle of the vehicle combination and which is fed with measurements from a camera;
repeatedly estimating a signal noise of the camera measurements;
adjusting the Kalman filter on the basis of statistics derived from the estimated signal noise;
obtaining an estimate of the observed articulation angle from the Kalman filter; and
providing maneuvering assistance based on the estimate of the articulation angle.
2. The method of claim 1 , wherein the adjusting the Kalman filter comprises adjusting a Kalman filter parameter corresponding to measurement noise covariance.
3. The method of claim 2 , wherein the adjusting includes adjusting a gain of the Kalman filter.
4. The method of claim 2 , further comprising:
detecting a signal fault of the camera measurement; and
for as long as the signal fault is detected, applying a maximum value of the measurement noise covariance.
5. The method of claim 1 , wherein the camera is located behind a rearmost axle of a vehicle ahead of an articulation point.
6. The method of claim 1 , wherein the Kalman filter is fed with measurements from a sensor, and the Kalman filter is invariant with respect to signal noise of the further sensor.
7. The method of claim 1 , wherein the maneuvering assistance includes low-speed maneuvering assistance.
8. The method of claim 7 , wherein the low-speed maneuvering assistance includes autonomous reversing.
9. The method of claim 1 , wherein the Kalman filter is a non-linear Kalman filter.
10. A non-transitory computer-readable medium comprising instructions which, when executed by a computer, cause the computer to:
initiate a Kalman filter which observes an articulation angle of the vehicle combination and which is fed with measurements from a camera;
repeatedly estimate a signal noise of the camera measurements;
adjust the Kalman filter on the basis of statistics derived from the estimated signal noise;
obtain an estimate of the observed articulation angle from the Kalman filter; and
provide maneuvering assistance based on the estimate of the articulation angle.
11. The non-transitory computer-readable medium of claim 10 , wherein the instructions executed by the computer, further causes the computer to adjust the Kalman filter parameter corresponding to measurement noise covariance.
12. The non-transitory computer-readable medium of claim 10 , wherein the instructions executed by the computer further cause the Kalman filter to be fed with measurements from a sensor, and the Kalman filter is invariant with respect to signal noise of the further sensor.
13. The non-transitory computer-readable medium of claim 10 , wherein the Kalman filter is a non-linear Kalman filter.
14. A maneuvering assistant system for a vehicle combination comprising:
an interface configured to receive measurements from a camera;
processing circuitry implementing a Kalman filter configured to observe an articulation angle of the vehicle combination on the basis of the measurements from the camera;
a signal analyzer configured to:
repeatedly estimate a signal noise of the camera measurement; and
adjust the Kalman filter on the basis of statistics derived from the estimated signal noise; and
an assistance unit configured to receive an estimate of the articulation angle from the Kalman filter and provide drive actions based on the estimate.
15. The maneuvering assistant system of claim 14 , wherein the assistance unit is configured with a vehicle model representing the vehicle combination.
16. The maneuvering assistant system of claim 14 , wherein the signal analyzer is configured to adjust the Kalman filter the basis of statistics derived from the estimated signal noise by being configured to adjust the Kalman filter parameter corresponding to measurement noise covariance.
17. The maneuvering assistant system of claim 14 , wherein the interface is configured to receive the measurements from the camera is located behind a rearmost axle of a vehicle ahead of an articulation point.
18. The maneuvering assistant system of claim 14 , wherein the Kalman filter is a non-linear Kalman filter.