Better keep state of unity navmesh agent and custom navmesh agent in sync, fix offset being applied twice