Added functionality to calculate distance to next wall ahead