add srv_kinematics_plugin/SrvKinematicsPlugin for whole_body