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

This reverts commit 4a89aa2554fdf778dfaf740c18e4298cc026c8ce.
Rebase from 'upstream'
Trimmed the branch to only the robocup_3d sub directory