The follower motion planning consists of two parts: waypoints generation and follower target position generation. The inputs for the desired waypoints generation of the follower are the relative pose estimated from perception subsystem and the follower pose estimated by the localization subsystem. Then the follower target pose is selected to have a longitudinal offset from … Continue reading Planning