Is your feature request related to a problem? Please describe. I used the moveit servo C++ API to create a Pose following setup for my robot. I want my robot to be adaptive and change tasks and goal ...