Guided Mode changes

This pull is implementing some safety feature on the guided mode.

The first one is to just allow entering guided mode via the mode spinner or RC controller. After you are in guided mode you can click on the map to go to other places.