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

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