• main() : collision_map_self_occ.cpp , collision_map_ground_plane_test.cpp
• spinThread() : collision_map_self_occ.cpp , collision_map_ground_plane_test.cpp
• TEST() : collision_map_ground_plane_test.cpp