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

This reverts commit 62a7554eb6e56ed918c5d92c01d6dcb1e5e46e71.
Rebase from 'upstream'
Trimmed the branch to only the robot_mechanism_controllers sub directory