Create trajectory_optimisation.py