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

This reverts commit 4ac5356772af320e4a9224ed34b87faf4266f49f.
Rebase from 'upstream'
Trimmed the branch to only the p2os_teleop sub directory