• load_model() : gazebo_plugins_interface
• normalize_angle() : set_pose
• normalize_angle_positive() : set_pose
• print_usage() : set_pose , set_wrench
• shortest_angular_distance() : set_pose