Nav mesh fixed

Still float but they follow you