Added a task to set the origin of the world.
Added parameters to goto to define it wrt the origin, or just do relative
movements.
Updated test mission accordingly