Progress on implementation of moveit helper class