SumoBot Testing and Avoid Logic

Echo sensor, motor config and phototransistor test code as well as
logic to avoid obstacles