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

This reverts commit 53aa771284720ee03b57ab333811d07575856571.
Rebase from 'upstream'
Trimmed the branch to only the pr2_mannequin_mode sub directory