uuv_mapping WORK IN PROGRESS Scene RGB camera Point cloud input Point Cloud filtered Background Subtraction Planner Obstacles at constant depth Working on Approximate cell-decomposition