Navmesh Update

Did some update with the navmesh, how the agents will react.