Commit changes from last night
Add dead-reckoning failsafes for both the beacon-seek and the sonar-approach modes