Revised three point turn routine slightly.
Added ultrasound support.