A ROS package that optimizes the mapping between the initial pose of a motion capture segment and the manipulator posture necessary to replicate this pose so as to minimize the robot joint velocity percentage usage for the entire motion capture trajectory.