Robotics, Autonomous Vehicles.
world coordinates. We can measure velocity and the yaw of the car as simplified with the bicycle model. The function search_target_index first finds the nearest point from the rear axle on the trajectory and then starting from that point calculates the index of the point on trajectory which is look