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

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