Small changes in the forward behavior: Will reduce linear speed if there is no lateral wall in sight, but otherwise will move at full speed. If seeing a wall that wasn't the last wall to follow, will align with it and only keeps the distance if the original dist is less than dist_ref.