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

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