Fix edge case for nav agent ground trace Properly simulate deceleration for nav agents New logic also tries to decelerate them as fast as possible