MSc thesis proposes novel optimisation algorithm for 3D trajectories