Pozycja referencyjna 2 - miejsce końca trajektorii (Pozycja końca trajektorii)
Pozycja referencyjna 1 - miejsce startu
l rajektoria robota od pozycji referencyjnej 1 do 2
orientacja 2
orientacja 1 / orientacja 3