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

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