Added a phasespace node for getting the gripper pose