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

This reverts commit e959f322c5271cef517fc7df31b4c4a393be3c51.
Rebase from 'upstream' (no changes)
Trimmed the branch to only the p2os_teleop sub directory