Improved wall-following derivative gain