Minor corrections
Elaborated mission to be controlled by gui via topic