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

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