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

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