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

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