Merge pull request #15 from pvieira3/manipulation

shortened wrist-to-graspPoint offset
changed IK error bool logic