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

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