Title: Surface modelling and surface following for robots equipped with range sensors