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

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