Biomedical Engineering Reference
In-Depth Information
cos
αα
sin
0
1
0
0
cos
γ
0
sin
γ
⎤⎡
⎤⎡
⎥⎢
⎥⎢
i
R =
1
sin
αα
cos
0
0 cos
β
sin
β
0
1
0
⎥⎢
⎥⎢
⎥⎢
⎥⎢
0
0
1
0 sin
β
cos
β
sin
γ
0
cos
γ
⎦⎣
⎦⎣
which gives the following analytical form, as a function of
the three angles:
cos
αγ
cos -sin
αβγ
sin
sin
-sin
α β αγ
cos
cos
sin
+
sin
αβ γ
sin
cos
⎡⎤
i
1
R
=
sin
α
cos
γ
+
cos
α
sin
βγ
sin
cos
α
cos
β
sin
α
sin
γ
cos
α
sin
βγ
cos
= ⎣⎦
δ
i
ij
-cos
βγ
sin
sin
β
cos
β γ
cos
where
ij represents the element in i th line and j th column of
the matrix.
δ
To obtain the values of these joint angles, at each instant
of the movement, we use the simplest elements of this
matrix from the following trigonometric functions:
δ
1
α
=
tg
12
⎝ ⎠
δ
22
(
)
1
β
=
sin
δ
32
δ
γ
=
tg
1
31
⎝ ⎠
δ
33
However, it can be seen that in these expressions, the
cosine of angle
appears in the denominator for the
calculation of angles
β
, which is a problem when it
becomes close to zero; in other words, when
and
α
γ
β
is close to 90°.
δ
−−
(sin .cos )
α
β
α
=
tg
1
12
=
tg
1
⎜ ⎟
δ
cos
α
.cos
β
⎝ ⎠
22
Search WWH ::




Custom Search