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

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