fixed followtrajectory

still doesnt work