wbt_lidar_tophat_transform function

Lidar tophat transform