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

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