Dane
Dwa położenie efektora: xs, ys, zs, a, p, 0 Wymiary geometryczne manipulatora: m, k
Rozwiązanie zadania odwrotnego kinematyki Wyznaczenie położenia początkowego i końcowego
(algorytm rozwiązywania zgodnie z rys. 6.5)
Wyznaczenie wielkości zmian położenia i orientacji Wyznaczenie optymalnej liczby podziałów toru
i?
I
Rozwiązanie zadania odwrotnego kinematyki dla wszystkich punktów ocechowanego toru
I
I
Animacja ruchu manipulatora
(ze wskazaniem położeń osobliwych)
Wyznaczenie i wykreślenie torów podpór napędowych 1 "-
END