Navmesh work

Work in progress, Dans section almost done