Interpolation as initial guess inisde Mission class

[Pep Martí Saumell]

The ability to give an interpolated trajectory should be inside the class. Inside, via switch case, we should be able to use different methods, e.g. SE3 or R3+SO3.