Use ultrasonics to reduce DRIVE_OVER_MAT time

Detect the beacon using the US to reduce how far onto the mat we travel.