wbt_lidar_segmentation function

Lidar segmentation