• alpha() : math_utilities.h
• angularMinus() : math_utilities.h
• getAverageQuaternion() : ori_tool.h , ori_tool.cpp
• getParam() : ros_utilities.h
• main() : test_kalman_filter.cpp , test_one_euro_filter.cpp , unit_test_lqr.cpp , test_traj.cpp
• minAbs() : math_utilities.h
• quatToRPY() : ori_tool.h , ori_tool.cpp
• rand01() : test_one_euro_filter.cpp
• rotationMatrixToQuaternion() : ori_tool.cpp , ori_tool.h
• sgn() : math_utilities.h
• square() : math_utilities.h
• TEST() : LqrTest.cpp
• xmlRpcGetDouble() : ros_utilities.h
• yawFromQuat() : ori_tool.h , ori_tool.cpp