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

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