Dodao debug code to output extraktovanu trajektoriju i entry/exit tacke.