Correcting a position of a vehicle with SLAM
A method for correcting a position of a vehicle when parking in a parking space. The method includes determining the position of the vehicle on the basis of odometry information, sensing ultrasonic signals from a linear object, carrying out a method for simultaneous localization and mapping (SLAM) on the basis of the linear object and the ultrasonic signals, and correcting the position of the vehicle A control device for a driving support system of a vehicle is also disclosed, which is designed to receive odometry information of the vehicle, to receive ultrasonic signals from at least one ultrasonic sensor of the driving support system, and to carry out the aforementioned method. A driving support system for a vehicle with an aforementioned control device and with at least one ultrasonic sensor is disclosed. The invention likewise relates to a vehicle with an aforementioned driving support system.
1. A method for correcting a position of a vehicle when parking in a parking space, the method comprising:
generating an estimate of the position of the vehicle on the basis of odometry information of the vehicle;
sensing ultrasonic signals from a linear object;
sensing the linear object in a longitudinal direction of the vehicle by at least one ultrasonic sensor;
carrying out a method for simultaneous localization and mapping (SLAM) of the vehicle in a map of an environment surrounding the vehicle on the basis of the linear object and the ultrasonic signals, wherein the SLAM is performed based on the ultrasound signals providing distance information only by correlating the ultrasound signals with one another; and
correcting the estimate of the position of the vehicle in the map on the basis of odometry information by the simultaneous localization and mapping on the basis of the linear object.
2. The method according to claim 1 , wherein sensing the linear object in the longitudinal direction of the vehicle comprises verifying the sensed ultrasonic signals as belonging to the linear object.
3. The method according to claim 1 , wherein sensing the linear object in the longitudinal direction of the vehicle comprises sensing a plurality of linear objects, and the method further comprises assigning the sensed ultrasonic signals to one of the plurality of linear objects.
4. The method according to claim 3 , wherein verifying the sensed ultrasonic signals as belonging to the linear object and/or the step of assigning the sensed ultrasonic signals to one of the linear objects comprises a determination of a Mahalanobis distance.
5. The method according to claim 1 , wherein carrying out a method for simultaneous localization and mapping comprises carrying out a Kalman filtering comprising:
generating an initial estimate of the position of the vehicle using an odometry function, based on the odometry information; and
correcting the initial estimate of the position on the basis of the linear object.
6. The method according to claim 5 , further comprising determining the odometry parameters of the vehicle.
7. The method according to claim 6 , wherein determining the odometry parameters comprises adapting the odometry function of the Kalman filter.
8. A control device for a driving support system of a vehicle which is configured to:
receive odometry information of the vehicle;
receive ultrasonic signals from at least one ultrasonic sensor of the driving support system; and
carry out the method according to claim 1 .
9. A driving support system for a vehicle comprising a control device according to claim 8 ; and at least one ultrasonic sensor.
10. A vehicle with a driving support system according to claim 9 .