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

This reverts commit 4fda9506ffb617a24a55e77555b39f67d469ead4.
Rebase from 'upstream'
Trimmed the branch to only the pr2_mechanism_diagnostics sub directory