added ultrasonic controller, reworking operator
lab complete
cleaned up code