Changed travelTo for smoother angle correction

Now it will only call turnTo when the correction angle is greater
than 5 degrees.
Else it will use a "p-controller" style approach and make one of the
wheels spin faster than the other, proportional to the correction angle.