working contoller and moveit
Merge branch 'master' of https://github.com/cdrwolfe/phantomx_arm

Updated to now connect to robot arm through moveit!