Dane
Dwa położenia efekt ora: xs, ys, zs, a, p, 0 Wymiary geometryczne manipulatora: m, k Trajektoria efektora wygenerowana zgodnie z 7.15
f Ocechowanie trajektorii efektora
liczba_podziałów; i=0;
Rozwiązanie zadania odwrotnego kinematyki dla i-tego położenia ocechowanej trajektorii
(algorytm z rys. 6.5)
^ Wyznacz i zapisz pozycje podpór A., B.:, C. ^
Nie
Wyznacz prędkości i przyśpieszenia wszystkich podpór napędowych
END