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

This reverts commit 6c8d4bb5c6c675d8c0060b0ea6786d0fb368565b.
Rebase from 'upstream'
Trimmed the branch to only the nav_msgs sub directory