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

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