Solve regression when teleporting with async (#5705)

While solving the issue with invalid position being used under heavy load, I introduced a regression that prevented the position to be updated in case of teleport. Move the logic in its own function and decide in PhysicsSystem whether a reset is needed.