Added features from the PR2 MoveIt config

This pull request it to double check with @isucan that these changes are ok