SumoBot Testing and Avoid Logic

Echo sensor, motor config and phototransistor test code as well as
logic to avoid obstacles
Merge pull request #1 from Albertjvanr/master

SumoBot Testing and Avoid Logic