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

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