Refactor path following, fix issues with animals, slow down after root motion anims remain, isReachable inconsistent, swim speed not handled