wbt_lidar_remove_outliers function

Lidar remove outliers