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

This reverts commit 5902021719c8dee884ef9d270667dd7b83964649.
Rebase from 'upstream'
Trimmed the branch to only the humanoid_nav_msgs sub directory