Take into account velocity when evading

When evading take into account current speed and try to reverse for
aproximately same distance and turn same amount, whatever the current
velocity of the robot is.