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

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