fixed robot coordinate transformation bug.
Merge pull request #25 from uh-klk/master

fixed robot coordinate transformation bug.