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

This reverts commit df737909159bc2ea835354243becefa8fbad921d.
Rebase from 'upstream'
Trimmed the branch to only the r2_teleop sub directory