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

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