C++ zmiana koordynatów obiektu

Dzień dobry.
Uruchamiajac wątek powyższej funkcji w silniku gry, napotykam problem zawieszania się programu.
Debugger nic nie wyrzuca
Chodzi o funkcję Ped::goToCoords(…)
ped.zip (2,7 KB)