19
Funkcje trygonometryczne sumy i różnicy kątów:
cos(0j + 02) = C12 = C1C2 - S1S2 sin(0! + 02) = S12 = C1S2 + sic2 cos(#i — 02) = C1C2 + S1S2 sin(6*i - 62) = S1C2 - C1S2
Rozwiązanie PZK dla robota typu 3R:
C1C23 -ClS23 S! Z2C1C2 + i3ClC23
°4T =
(4)
S1C23 —S1S23 —Cl Z2S1C2 + Z3S1C23
S23 C23 0 /2S2 + Z3S23
0 0 0 1
20
rf |
IT |
^3 igPi |
r | ||
Ir |
i’ | |
H |
f |
[e Q |
i |
r |
<t> 0 |
s |
& |
J |