-added ultrasonic function that changes the color of the lights
-encoder testing stuff
merged