wbt_lidar_ground_point_filter function

Lidar ground point filter