Remove debugging code.
Start coding change_trajectory function.