Finished base

This is a copy of ultrasonic.c It will be changed to reflect using just
the front ultrasonics.