Merge pull request #3 from WPI-RAIL/develop

cmdunkers
updated the joint names
Merge pull request #19 from cmdunkers/develop

updated the joint names