Wayfinding method and device
An automatic wayfinding method for an ego or first vehicle is disclosed. The method includes receiving position information transmitted by at least one lead vehicle and constructing a route based on the received position information.
1. An automatic wayfinding method for a first vehicle comprising:
receiving position information transmitted by at least one vehicle ahead;
constructing a route for the first vehicle based on the received position information, by:
acquiring environment information;
determining the position of the first vehicle relative to a lane marking based on the environment information and the constructed route;
steering the first vehicle at a prescribed distance when the distance from the lane marking lies within a permissible range; and
outputting an indicating signal when the distance from the lane marking lies outside the permissible range; and
steering the first vehicle along the constructed route;
wherein a weighting given to the constructed route by comparison to the environment information is increased as the number of vehicles ahead used to construct the route increases.
2. The method according to claim 1 , wherein constructing a route comprises calculating a best-fit curve from the position information for a plurality of vehicles ahead.
3. The method according to claim 2 , further comprising identifying at least one vehicle ahead from the plurality of vehicles ahead travelling on a different lane that the first vehicle, and discarding the received position information for the at least one vehicle ahead traveling on a different lane than the first vehicle.
4. The method according to claim 3 , further comprising reconstructing an improved route of at least one vehicle ahead after discarding the received position information.
5. The method according to claim 4 , further comprising:
reconstructing a plurality of routes for a respective plurality of vehicles ahead of the first vehicle;
wherein the improved route is reconstructed based on the reconstructed plurality of routes.
6. An automatic wayfinding method for a first vehicle comprising:
receiving position information transmitted by at least one vehicle ahead;
constructing a route for the first vehicle based on the received position information, by:
acquiring environment information;
determining the position of the first vehicle relative to a lane marking based on the environment information; and
reconstructing an improved route of at least one vehicle ahead when the prior position determining step has failed; and
steering the first vehicle along the constructed route, the improved route comprising the constructed route.
7. The method according to claim 6 , wherein the decision as to whether the position determining step has failed is a function of the number of vehicles ahead based upon which the route is constructed.
8. An automatic wayfinding driver assistance system for a first vehicle comprising:
a receiver configured to receive position information for at least one vehicle ahead;
a controller configured to construct a route based on the received position information; by:
acquiring environment information;
determining the position of the first vehicle relative to a lane marking based on the environment information; and
reconstructing an improved route of least one vehicle ahead when the prior position determining step has failed; and
steering the first vehicle along the constructed route, the improved route comprising the constructed route.
9. The driver assistance system according to claim 8 , wherein the receiver comprises a V2V radio interface.
10. The driver assistance system according to claim 8 further comprising an environment sensor configured to acquire environment information.