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

This reverts commit 65593be8519978e23e234d247ce653dc6679c363.
Rebase from 'upstream' (no changes)
Trimmed the branch to only the humanoid_nav_msgs sub directory