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

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