• main() : joy_dummy.cpp
• odom_msg_to_lin_vel() : control_utils.h
• odom_msg_to_rotation_matrix() : control_utils.h
• odom_msg_to_xyz() : control_utils.h
• odom_msg_to_ypr() : control_utils.h