Add DOFs of mobility to DOFs of manipulator to add user defined tasks to motion