Tabulka parametrů (Denavit-Hartenberg)
0
1
2
3
Výchozí poloha
Parametry pohybu koncového bodu
Trajektorie koncového bodu ve 3D
Matice ve výchozí poloze
Výchozí poloha
Matice ve výchozí poloze
Matice výchozí polohy
Jakobiho matice ve výchozí poloze
Tento zápis je matematicky správný, ale v ptosředí Matcad neplatný. Mathcad nesprávně přiřadí hodnoty, do matice nelze zapsat vektor, popř. jinou matici. Je nutno vkládat přímo jednotlivé prvky
Žádaná hodnota na regulátory polohy
Další hodnota
Matice ve výchozí poloze
Matice výchozí polohy
Jakobiho matice ve výchozí poloze
Žádaná hodnota na regulátory polohy - zde je vidět, že rychlost je větší a tedy i změna polohy koncového bodu za nastavený časový krok - výpočet již není tak přesný, ale vyhovuje
Obdobně by výpočet pokračoval dále, naprogramovaný v některém vhodném programovacím jazyce
Program v prostředí Mathcad, zadána výchozí poloha koncového bodu a výchozí kloubové proměnné
Počáteční kloubové proměnné
Definice výpočtové funkce - argumenty této funkce jsou žádané hodnoty xd,yd a zd. Pozor - indexy u kloubové proměnné jsou indexy vektoru s (vkládané levou hranatou závorkou), ne textové indexy (ty se vkládají pomocí tečky)
Použití programového výpočtu