Make control of physical phantomx arm work

The gripper still needs to be manually controlled, need to test the gripper service better.
Also updated the phantomx urdf to match my mounting