• getIdealTarget() : test_icp.cpp
• getPoseDistance() : perception.cpp
• main() : auto_dock.cpp , test_low_pass_filter.cpp , test_icp.cpp
• printVector() : test_low_pass_filter.cpp
• readHistoryFromFile() : test_low_pass_filter.cpp
• TEST() : test_icp.cpp , test_low_pass_filter.cpp , test_icp.cpp