Begun to implement moveit convenience class