Replaced Position with Turn, altered stepper so that it switches all pins off
if motor values are zero
Reduced Sonar timeouts from 100ms to 40ms to improve CPU loading