NavigationSystem almost finished (missing mutex)