Differences
This shows you the differences between two versions of the page.
|
vdvac:lab7 [2026/05/14 11:28] anca.morar [Inverse kinematics cu algoritmul Fabrik] |
vdvac:lab7 [2026/05/14 11:35] (current) anca.morar [Inverse kinematics cu algoritmul Fabrik] |
||
|---|---|---|---|
| Line 18: | Line 18: | ||
| **Algoritm** | **Algoritm** | ||
| * Date de intrare: | * Date de intrare: | ||
| - | * pozițiile joncțiunilor $p_i$ cu $i = 1 .. n$ | + | * pozițiile joncțiunilor $p_i$ cu $i = 0 .. n-1$ |
| * poziția dorită (target) $t$ | * poziția dorită (target) $t$ | ||
| - | * distanțele dintre fiecare două joncțiuni (lungimea fiecărei legături): $d_i = |p_{i+1}-p_i|$ cu $i = 1 .. n-1$ | + | * distanțele dintre fiecare două joncțiuni (lungimea fiecărei legături): $d_i = |p_{i+1}-p_i|$ cu $i = 0 .. n-2$ |
| + | * dacă $|p_0 - t | > d_0 + d_1 + ... + d_{n-2}$ (target-ul nu poate fi atins) atunci | ||
| + | * se găsește vectorul $(t - p_0)$ și se determină poziția relativă a fiecărei joncțiuni de-a lungul vectorului (se întinde întreg lanțul în direcția punctului țintă) | ||
| + | * altfel (target-ul poate fi atins) | ||
| + | * se calculează distanța dintre end effector și target $diff = |p_{n-1} - t |$ | ||
| + | * cat timp ($diff > prag) | ||
| + | * executa iteratia forward | ||
| + | * executa iteratia backward | ||
