Poruszanie się po wyznaczonym torze

Witam, myślę już nad tym jakiś czas i średnio mi to idzie. Chciałbym aby w moim programie pewien graficzny obiekt poruszał się po torze z punktu A do B. Wymyśliłem to w ten sposób, żeby w klasie tor utworzyć 2 x ArrayList które przechowują punkty x i punkty y, a potem iteratorem się po tym poruszać. Tylko to chyba się nie sprawdzi z powodu wielowątkowości. Dlatego nie wiem za bardzo jak się za to zabrać,
Z góry dziękuję za pomoc.

Wcześniej próbowałem zrobić to tak:
W klasie tor generowałem ruch:

 
    void generujRuch(ObiektRuchomy o){
        zmienKierunek(o.getX(),o.getY());
        
        if((o.getX() == punkt_koncowyX)&&(o.getY() == punkt_koncowyY) return;
        
      
            if(getKierunek()==1) o.setY(o.getY()-1);
            if(getKierunek()==2) o.setY(o.getY()+1);
            if(getKierunek()==3) o.setX(o.getX()+1);
            if(getKierunek()==4) o.setX(o.getX()-1); 
    }

Tylko w przypadku utworzenia nowego wątku obiektu ruchomego kierunek jest zmieniony, a chcę, żeby kierunek początkowy był taki sam