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

This reverts commit 3979027c25cf3fdb4c738f2369b851f646fd3eb7.
Rebase from 'upstream'
Trimmed the branch to only the nav2d_karto sub directory