Updated the function for following the wall. Now we are decreasing the velocity proportional to the velocity