Added a bit of randomness to the equation
Near zone avoidance and small bug fixes to stop robot getting stuck at
walls edge