Got ultrasonic sensor and light sensor working simultaneously. Removed servo commands from main testing program.