Matrici di Rotazione
Attorno X
Attorno Y
Attorno Z
RX(θ) =
- 1 0 0
- 0 cθ -sθ
- 0 sθ cθ
RY(θ) =
- cθ 0 sθ
- 0 1 0
- -sθ 0 cθ
RZ(θ) =
- cθ -sθ 0
- sθ cθ 0
- 0 0 1
RX RY ≠ RY RX
Cinematica
Cinematica Polso Sferico
Old finite-motion
- g3 = [o1 o o2]
t ∈ [0, 1]
- θ1(t) = π/3 sin(2πt)
- θ2(t) = π/6 [cos(2πt) - 1]
- θ3(t) = π/3 sin(2πt)
Risoluzione
{g0 = R03} | g3
R03 = R03(t) perché gli angoli variano nel tempo
R03 = R01 R12 R23 = RX(θ1) RY(θ2) R2(θ3)
{g0 = RX(θ1) RY(θ2) R2(θ3)}
- o1
- 0
- o2
- t = linspace (0, 1, n)
- for i = 1:n
- R01 =
- R02 =
- R03 =
9 . 0 (i, :) = R03
- [01
- 0
- 02]
end
θ1 =
θ2 =
θ3 =
MATRICI DI ROTAZIONE
ATTORNO X
Rx(θ) =
- [1 0 0]
- [0 cosθ -sinθ]
- [0 sinθ cosθ]
ATTORNO Y
Ry(θ) =
- [cosθ 0 sinθ]
- [0 1 0]
- [-sinθ 0 cosθ]
RxRy ≠ RyRx
CINEMATICA
CINEMATICA POLSO SPERICO O.d.: finite-motion
|9̅|3 = [0.1 0 0.2]
t ∈ [0,1]
θ1(t) = π/3 sin(2πt)
θ2(t) = π/6 [cos(2πt) - ]
θ3(t) = π/3 sin(2πt)
RISOLUZIONE
|9̅0| = R03 |9̅|3
R03 = R03(t) perché gli angoli variano nel tempo
R03 = R01 · R12 · R23 = Rx(θ1) · Ry(θ2) · Rz(θ3)
|9̅0| = [
- Rx(θ1), Ry(θ2), Rz(θ3)] [0.1
- 0
- 0.2
t = linspace(0, 1, n)
for i = 1 : n
- R01 =
- R02 =
- R03 =
q0(:, i) = R03
end
SERIAL ROBOT: DIRECT POSITION ANALYSIS
θ1, θ2, θ3
θrot
0 = [0° -30° -30° 60°]T
θ̇=[1,-1 2 1]T
th4=0 e deg2rad(90)
t ∈ [0,1]
RISOLVE
|prot0 = T03 |prot3
T03 = T01·T12·T23
Il braccio robotico ROTOTRASLA
Trot01=[Rx (θ1) 000 0 0 1]
Trot12=[Ry (θ2) 000 0 0 1]
Trot23=[Rz (θ3) 000 0 0 1]
Ttrasl01=[1 0 0 |t01|0 1 0 |0 |0 0 1 |0 |0 0 0 |1 |]
Ttrasl12=[I |r12|0 0 0 1]
Ttrasl23=[I |r23|0 0 0 1]
T01.r = T (Rz (th4·0), zeros(3,1));
T01.t = T (eye (3,3) |0;0;e4|);
T01 = T01.r · T01.t;
--
T03 = T01 · T12 · T23;
for i : 1 : n
dt = t(i) - t(i-1)
th4 = th4(i-1) + th4d · dt
function hom = T (R, t)
R3x3 t3x1 = [R t ;0 0 0 1; ]
end
CINEMATICA POLSO SFERICO
DATI:
- θ1(0) = 30°
- θ2(0) = 20°
- θ3(0) = 60°
LEGGE DI MOTO:La velocità angolare è costante
- θ1(t) = 1 rad/s
- θ2(t) = 1 rad/s
- θ3(t) = 2 rad/s
- θ1(t) = 0.1 rad/s2
- θ2(t) = -0.1 rad/s2
- θ3(t) = 0.2 rad/s2
- {ω03}0
- j
- {θ03}0
1) {ω03}0 = {ω0}0
Scarica il documento per vederlo tutto.
Scarica il documento per vederlo tutto.
Scarica il documento per vederlo tutto.
Scarica il documento per vederlo tutto.
Scarica il documento per vederlo tutto.
Scarica il documento per vederlo tutto.