Change default position to avoid singularities
Add custom pr2 description for simplification
Merge branch 'groovy' of https://github.com/bcoudrin/sot_pr2 into groovy