Revert "Trimmed the branch to only the pr2_mannequin_mode sub directory"

This reverts commit 0f9afc995b508e35f615fc9116034b0d02c96b24.
Rebase from 'upstream' (no changes)
Trimmed the branch to only the pr2_mannequin_mode sub directory