METHOD FOR ASCERTAINING AN INITIAL POSE OF A VEHICLE
DRIVE
July 13, 2023
A method for ascertaining an initial pose of a vehicle using a control device. Measured data ascertained by a GNSS sensor system and/or an odometry sensor system are received and evaluated to ascertain an approximate pose of the vehicle with a margin of uncertainty. At least one trajectory of road users is extracted from a trajectory map for the ascertained margin of uncertainty. Test points are positioned along the extracted trajectory. An optimization algorithm is performed for each test point along the trajectory. The optimization algorithm ascertains poses having corresponding cost functions. A pose having the greatest cost function is determined as the initial pose of the vehicle from the poses ascertained by the optimization algorithm. A control device, a computer program, and a machine-readable storage medium are also provided.
Discussion in the ATmosphere