Multiple NaviMaps in world; AI tracking working for multiple agents

Also fixed some bugs in navigation and tracking