Robust And Efficient Surface Interpolation Algorithms For Sonar Based Obstacle Negotiation Of A Mobile Robot