Rover: added waypoint passed logic to RTL

this prevents circling around home
Rover: new failsafe logic

this obeys FS_TIMEOUT and FS_ACTION
Rover: added SONAR_DEBOUNCE option

this allows us to debounce the sonar triggering, which will make it
handle noise better