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

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