Merge pull request #17 from dpsolomon/groovy-devel

Updates to avoid_joint_limits constrain