Home position

This sets the home position on the first reasonable good GPS fix and announces it to the system and via MAVLink to the GCS.

Tested outdoors, non-intrusive, ready to be merged.