trajectory follwoing bugfix