Start refactoring code
Refactor navmesh generation