Trajectory following complete