fixed some compile issues worked on nav-meshes added some tests
started adding code for synthetic sensor simulation based on given paths