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

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