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

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