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

This reverts commit 572aa7813a0d63ffd1fa59f630739bb4887bae5e.
Rebase from 'upstream'
Trimmed the branch to only the robot_model sub directory