HAL Id: tel-00629228
https://tel.archives-ouvertes.fr/tel-00629228
Submitted on 5 Oct 2011
HAL is a multi-disciplinary open access archive for the deposit and dissemination of sci- entific research documents, whether they are pub- lished or not. The documents may come from teaching and research institutions in France or abroad, or from public or private research centers.
L’archive ouverte pluridisciplinaire HAL, est destinée au dépôt et à la diffusion de documents scientifiques de niveau recherche, publiés ou non, émanant des établissements d’enseignement et de recherche français ou étrangers, des laboratoires publics ou privés.
Plannification des prises pour la manipulation robotisée
Belkacem Bounab
To cite this version:
Belkacem Bounab. Plannification des prises pour la manipulation robotisée. Automatique / Robo-
tique. Université Paul Sabatier - Toulouse III, 2011. Français. �tel-00629228�
! !
!"#$%&#'&#()*+,&",-*"#'% !
!"#$"%&$'!(')*+,-.(%/-$0'!('$"+)"+/(' !
! ./(-$0/#120#3 ' .-45-1(-"&#*%#41/5-2(-,/#3
! !
!
!
60/4&",/&#&,#4*%,&"%x#3#
! ! 7-,0 !
! !
! !
!
!
!
!
!5*(&#'*5,*02( 8"-,/#'�&59&059 .-0&5,&%0:4;#'O<4
=211*0,&%04#3 (
>%,0&:4;#?&?+0&:4;#'%#@%0A#
Université Toulouse 3 Paul Sabatier (UT3 Paul Sabatier)
Systèmes (EDSYS)
Planification de prises pour la manipulation robotisée
mardi 7 juin 2011
Belkacem Bounab
Systèmes Automatiques
Veronique Perdereau - Professeur à l'Université Pierre et Marie Curie-ParisVI, France.
Belkacem Barkat - Professeur à l'Université de Batna, Algérie.
Daniel Sidobre - Maître de Conférences (HDR) à l'UPS, Toulouse, France.
Abdelouhab Zaatri - Professeur à l'Université de Constantine, Algérie.
LAAS-CNRS
Jean-Jaques Barrau - Professeur à l'UPS, Toulouse, France.
Taha Chittibi - Maître de conférences à l'École Militaire Polytechnique, Alger, Algérie.
R
3i
A
g
∆
∗gQ
GQ
Gr
ballQ
∗G1 T ∗
r
ball−
π2! ψ !
π2π
2
< ψ <
3π2x β
ψ l = 1
µ = 0.3
µ = 0.5
Q
1r
ballq
i1∈ [0, 144]
◦q
i2=
q3i1+ 40
◦[Q
1, r
ball] [0.875, 0.604] [0.741, 0.492]
[1.960, 0.302] [1.430, 0.347] [1.120, 0.379] [1.724, 0.308]
•
•
•
•
•
•
•
•
n
•
•
•
f
t≤ µf
nf
nf
tµ > 0 µ
µ
R
3!
f
x2+ f
y2≤ µf
z, f
z≥ 0, = (f
xf
yf
z)
T∈ R
3f
xf
yf
zn
i i
i
i
α = tan
−1µ
in
!
f
ix2+ f
iy2! µf
iz, (i = 1 · · · n)
m
i
i
=
m
"
j=1
a
ij ij;
ij=
i ij, a
ij" 0
A
ii
ij
j i
ij T
ij i
= 1
#
mj=1
a
ij ii
i1 i2 i
i i
i
= a
i1 i1+ a
i2 i2a
i1a
i2i/
=
i×
i ii/
i
i
=
i i/
=
i×
i
=
m
"
j=1
a
ij ijij
ij
=
ij i
×
ij
L
∞W
L∞W
L∞=
n
*
i=1
W
iW
i=
i
|
i=
m
"
j=1
a
ij ij, a
ij≥ 0,
m
"
j=1
a
ij≤ 1
m
n6 W
L∞= ConvexHull
+
n*
i=1
{
i1, . . . ,
im} ,
W
L1=
g
|
g=
n
"
i=1 m
"
j=1
a
ij ij, a
ij≥ 0,
n
"
i=1 m
"
j=1
a
ij≤ 1
W
L1= ConvexHull +
n-
i=1
{
i1, . . . ,
im} ,
mn W
L∞⊇ W
L1g
g
∈ R
3g
∈ R
6k {
1, . . . ,
k}
R
dR
dλ
1, . . . , λ
k= λ
1 1+ · · · + λ
d dmn
W = {
11, . . . ,
mn} R
6( ,
x,
y,
z)
c
1z c
21
z
2
c
1
c
2z
1z
2!0.6
!0.4 !0.2
0 0.2
0.4 0.6 !0.25!0.2!0.15!0.1!0.05 0 0.050.1 0.150.20.25
!0.8
!0.6
!0.4
!0.2 0 0.2 0.4 0.6 0.8
w11
fy
w22
w12
fx w21
tz
O
!0.6
!0.4 !0.2
0 0.2
0.4 0.6 !0.25!0.2!0.15!0.1!0.05 0 0.050.1 0.150.2 0.25
!2
!1.5
!1
!0.5 0
w11
fy w22
w12
fx
tz
w21
O
{
x,
y,
z,
x,
y,
z}
+
( ,
x,
y,
z)
!3
!2
!1 0
1 2
3
!3
!2
!1 0 1 2 3
!0.5 0 0.5
y x
z
c2
c1
c3
!2 0
2 4
!3
!2
!1 0 1 2 3
!0.5 0 0.5
x y
z
c2
c3 c1
!1 0
1
!1 0 1
!0.5 0 0.5
fx
fy fz
!2 0
2
!2 0 2
!2
!1 0 1 2
tx ty
tz
0 0.5
1
!1 0 1
!0.5 0 0.5
fx
fy fz
!2 0
2
!2 0 2
!2
!1 0 1 2
tx ty
tz
!"
!#
!$
!"
!#
!$ !
!
!
!"
#
$
!
"#$
"$%
"%!
"#!
&#$'
&%!'
1
,
2,
3W
1
,
2,
3 1,
2,
31
,
2,
3a
1 1+ a
2 2+ a
3 3= ; (a
1, a
2, a
3) > 0
W
1
,
2,
3,
412 34
C
12<C
34<(
1,
2)
(
3,
4)
W
1
,
2,
3,
41
, . . . ,
4 1, . . . ,
4 12 341 2 3 4
(a
1, a
2, a
3, a
4) > 0
34
−
12= ±(a
1 1+ a
2 2) = ∓(a
3 3+ a
4 4)
n
n n
=
n
>
n
3 × n
n
n
n
max
n
d
tel que :
n n=
n
− "
d " 0
n
"
d
∗d d
∗∗n
d
∗n
=
! (
"
#
!
"
# $
%
1 1.1 1.2 1.3 1.4 1.5 1.6 1.7
0 0.05 0.1 0.15 0.2 0.25 0.3 0.35
! (rad)
d*
!* = 1.2 rad
α [1.052,
π2]
α
n
=
0 0 1 − cos(α) 1 1 0 − sin(α)
−l 0
7l40
; =
−
; =
−
−
4 × 4
α α ≈ 1.2
n n ≥ 3
π − 2α
n
O(N
4)
n 3 2n
(f
x, f
y, t
z)
⊕ * ±
* ⊕
±
!"#
!"#
$!$
$!$
!"#
!"#
$!$
$!$
!!!"
!"
!!!"
#
$
#
#
$
!
!
"!
#!
#$!
"$"
"
!
!
!!
"!
#$
$
$
⊕ *
f
xf
yt
z
+→
−f
x/t
zf
y/t
z
w w
%w
iw
%i{w
%i}
*
(w
1%w
%2)
i j k
−−→
k i×
i+ −−→
k j
×
j=
j
−−→
j k−−→
k i
×
i jj2
−−→
j k
j1
−−→
j k j1
−−→j k
'−−→j k'
12
jkj k i
i1 i2
jk
jk i
c
ic
jc
kf
if
jsi1 si2
sj1 sj2
i j
c
iBjk si1
si2
c
i Bjk si1 si2
c
i Bjk si1 si2
jk
i
7
O(N
d) N d(= 3 6)
N 2N
n
w
ij=
N1#
N i=1w
iR
6H(W )
N
(w
i− )
Tx ! 1 ; i = 1, 2, . . . , N.
H(W ) N
z =
TE = (e
1, e
2, . . . , e
6) H(W )
e
1x
1+ e
2x
2+ e
3x
3+ e
4x
4+ e
5x
5+ e
6x
6= 1
!"#$%&'(&)*&+(
,-%.&)*&$,/$&0")11%2%/1&& 1")*-%"&*/&!)#/1
&#/13"#%*"&! 1")*-%"&4,&0,.%11%&5678&
9:#/1%"$%.1#)/&,-%.&"!
!");",22%
4#/3,#"%
9#$16!<&=&9#$16!<&"8
)*#
/)/
0)".%>.4)$*"%
/)/&0)".%>.4)$*"%
!"#$%&'(#$)*$+!$,*
-.#/$+!$(-"($0&+11#2#"1$$ 1&+!.#&$!"$%+'"1
$'"13&'#!&$! 2-4'2'(#&$!
+!'
"+"
0+&/#5/6+(!&#
"+"$0+&/#5/6+(!&#
-.#/$7)8$9:; !
%&'7"#!;#$#9n
n
z
max(− ) < 1
n
i1, n
i2(i = 1, 2, 3)
!
!"
#
!
!
"!!
"!"
!"#$%&'()'*"$%+*%
W R
nR
k<nR
6R
3R
3n
d
Tσ
min( )
Q = σ
min( )
σ
min( )
σ
min( )
Q = k
!
det(
T) = k(σ
1σ
2. . . σ
d) k σ
1, σ
2, . . . , σ
dQ = σ
minσ
max1 0
Q = 1 θ
maxn
"
i=1
| θ
i− θ |
θ
iθ
θ = π(n − 2)/n θ
max= (n − 2)(π − θ) + 2θ
0 π
!" !
A
L
min(x
i, y
i, z
i) (x
i0, y
i0, z
i0)
Q = 1 n
n
"
i=1
!
(x
i− x
i0)
2+ (y
i− y
i0)
2+ (z
i− z
i0)
2i
1 -
i- ! 1, i = 1 . . . n
m n
W =
n
"
i=1
w
i=
n
"
i=1 m
"
j=1
α
ijw
ij; α
ij" 0,
m
"
j=1
α
ij! 1
α
ijP
P = ConvexHull +
n*
i=1
{
i1, . . . ,
im} ,
n
1 #
ni=1
-
i- ! 1
W =
n
"
i=1 m
"
j=1
α
ijw
ij; α
ij" 0,
n
"
i=1 m
"
j=1
α
ij! 1 P
P = ConvexHull +
n-
i=1
{
i1, . . . ,
im} ,
P
P
Q = min
w∈∂P
- w -
∂P P
!
!!
"!
#!
"
!
#!
$!
%!
"
P
P
σ
minσ
minσ
min(σ
1, σ
2, . . . , σ
r)
Q = k
!
det(
T) = k(σ
1σ
2. . . σ
r) k
T
1
Q = σ
maxσ
minQ =
l
"
i=1
(θ
i− θ
0i)
2l θ
iθ
0ii Q
Q =
l
"
i=1
( θ
i− θ
0iθ
maxi− θ
mini)
2n n − 1 n
n − k k
n
120
◦240
◦D
n
Q
7
n
g
=
g g/
∆
g g∆
g=
g×g/
'g'2
+ λ
g:
g.= 0 + λ
g/:
g= 0
: λ ∈ R
∆
g g=
g'× g/g'2
g/
=
g·
g/-
g-
2 gg
.= 0
g
= 0
g/
j k
j k j
= a
j j k= a
k ka
j, a
ka
ja
kj k
j k
!
"
#
!$
!"#!
!!
"!
!!
"!
!!
"g
i
α
i
j k
!6 !4 !2 0 2 4 6
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y f
1
f3
f2
c2
c3
c1
∆g
!6 !4 !2 0 2 4 6
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y f1
c2
c3
c1
∆g
f2
f3
!4 !2 0 2 4 6 8
!6
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y c1
c2
c3
∆g
!8 !6 !4 !2 0 2 4
!5
!4
!3
!2
!1 0 1 2 3 4 5 6
X
Y
c3
c1
c2
∆g
( , )
( , )
i
a
i1a
i2!6 !4 !2 0 2 4 6
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c1
c2
c3
c4
∆g
!6 !4 !2 0 2 4 6
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c1
c3
c2
c4
∆g
∆g
!6 !4 !2 0 2 4 6
!6
!4
!2 0 2 4 6
X
Y
∆g
c4
c3
c2
c1
∆g
!5 0 5
!6
!4
!2 0 2 4 6
X
Y
c1
c2
∆g
c3
c4
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y ∆g
c1
c2
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c2
c1
∆g
∆g
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c2
c3 c1
∆g
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c1
c2
c3
∆g
c
1c
2!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c1
c2
∆g
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c1
c2
∆g
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c3 c1
c2
∆g
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y
c2
c1
c3
∆g
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y ∆g c1
c2
c3
c4
!5 0 5
!5
!4
!3
!2
!1 0 1 2 3 4 5
X
Y ∆g
c1
c2
c3
c4
(f
x, f
y, t
z)
n
k k
r
n − 1
k
= (
k,
k/ k)
T r= (
r,
r/ k)
T kk/ k k k
g
=
k+
r= = ⇒
:
r= −
kr/ i
= 0
g
∆
k k k∆
kk
∆
r r rk
∆
rk
n n
n − 1 ∆
r∆
kr
n − 1
∆
r r/ k∆
rr
∆
kk
∆
r∆
k r= −δ
kδ > 0
rr
∆
r k rk
k k
#
∆
rk n
∆
∗g= ∆
k;
∆
rR
2n
n
n
∆
∗gR
2n + −
n
R
2+ −
∆
∗g= ∆
i;
∆
rR
2n
g/∗g/
= :
∗g g/
<
∗g
∆
∗g g/∗g
g/ ∗
g
∗g/
∆
∗g∗g12 ∗
g23
R
2g/ +
t −
t
∗g12 ∗ g23 +
t −
t
R
2∗g
R
2 ∗g/!
!
"!
!
!
""
!
!
"#
"
! $#
!
!
"!"
!
!
"!#
"
! $$
# $
$%
!
"
!!
"
" !"
!!
"
""
∗g
n
+t − t
#
n
R
2n
∆
∗gR
2 "∆
∗g ∗g ∗g"" ∗"
g
R
2 "(
"− ) ×
∗g"#
2n
R
22n +
−
|
n
"
i=1
(t
i1+ t
i2) | −
n
"
i=1
(| t
i1| + | t
i2|) < 0 t
i1= · (
i×
i1) t
i2= · (
i×
i2)
∗g
∆
∗g(
j,
k) ∈ {Ω \
j.=
k}
Ω = {
11,
12,
21,
22, · · · ,
n1,
n2} 2n n
∗g
j k jk
jk
∗g1
=
j ∗g2=
k jk∗g j k
∗g
= (
j·
jk+
k·
jk)
' jkjk'
! !
"
"!#! !
"! ! !
""
! "
$
! ! ! "
!
!
"
!"! !
"! !
"# ! # "
!
! !
"# !
"
!
#
!
! !
"! !
"# !
!# "
!
! !
"# !
"
#
!
! !
"!
! !
""
∆
∗gj k
∗g
=
j+
k j k jk
∗g
=
j∗g
=
kj k
∗g
=
j+
kj k
∗g1
=
j ∗g2=
kn
∗ ∗gn
∗n
∗R
211 21
12 22
∗g1 ∗ g2 ∗
g3 ∗ g4
R
211 21 22
12
∗g1 12 22
∗g2 ∗ g3
R
2∗g1
∗g3 ∗
g2 12 22
∗g1 ∗ g2 ∗
g3
R
2#
!!#
!"!
!"
"""
"!!
"#
!!!"
!!!#
!!!$
!!!%
"#$
%&%'()*+
$ &
#
!!#
!"!
!"
"""
"!!
"!!!!
!!"#
!"!$
! %
#
!!#
!""
!#
""#
"!"
"#
!"!!
!"!#
!"!$
"#$
S
2 S
max= 4π
∗g-
j+
k-= 2
Q
G= ω
1S
4π − ω
2-
c-
2ω
1ω
2Q
Gc
∆
∗gn
∗ ∗gR
2Q
Gn
∗n
Q
Gr
ballR
33 2n
4
α
4
4
α ∈ =
1.0,
π2>
α (tan
−1(
74) < α <
π2)
Q
Gα
∗= 1.25
Q
G!0.5 0 0.5 1 1.5 2 2.5 3
!1 0 1 2 3 4 5
X
Y gc
o f2
f4
f∗1 3
1 1.1 1.2 1.3 1.4 1.5 1.6 1.7
!3.2
!3.19
!3.18
!3.17
!3.16
!3.15
!3.14
!3.13
!3.12
!3.11
α ( r a d ) QG
α∗= 1.2 5 r a d
QG α
n
r
x= 2 r
y= 1
iθ
ii
= (r
xcos θ
ir
ysin θ
i)
i
i
= −k
i−1
r
ycos θ
ir
xsin θ
i
; k = ! r
x2+ r
2yα = 20
◦µ = 0.364
10000
2048
14
140
Q
G10000
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X o
c1 c2
c3
c4
QG= 0.593
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X
c1 c2
c3
c4
o
QG= 0.638
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X o c4
c2
c3
c1
QG= 0.689
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X c1
c3
o c4
c2
QG= 0.748
Q
GQ
Gr
ballQ
Gr
ballr
ballQ
GR
30 0.2 0.4 0.6 0.8 1
0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1
rb a l l QG
Q
Gr
ball!4 !2 0 2 4 6
!3
!2
!1 0 1 2 3 4 5
X
Y
QG= 0.177
!4 !2 0 2 4 6
!3
!2
!1 0 1 2 3 4 5
X
Y
QG= 0.426
!4 !2 0 2 4 6
!3
!2
!1 0 1 2 3 4 5
X
Y
QG= 0.611
rball= 0.134 rball= 0.196 rball= 0.437
0
∗
Q
GQ
G150 100 ∗ n 0.95
Q
GQ
Gµ = 0.364 α = 20
◦θ
i10 150 1.062
0.015 100
0.484
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X
c1
c2 o
gc
Q∗G= 0.205
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X c1
c2 gc o
Q∗G= 0.205
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X c3
c1
c2 gc o
Q∗G= 0.432
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X c1
o
gc c2
c3
Q∗G= 0.464
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X c1
c2 gc
o
c3 c4
Q∗G= 0.748
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X gc o
c1 c2
c3
c4 c5
Q∗G= 0.773
!2 !1 0 1 2
!2
!1.5
!1
!0.5 0 0.5 1 1.5 2
Y
X gc o
c1 c2
c3
c4 c5
Q∗G= 0.773
0 20 40 60 80 100 120 140 160
−1
−0.5 0 0.5
!"
#$%&'$()*
!
Q
∗Gj
j =
1, . . . , N
is
i∈ [0, 1]
i = 1, . . . , n
i
=
k+ (s
i− sp
k)
k+1−
ksp
k+1− sp
kk (s
i∈
[sp
k, sp
k+1]) sp
jj = 1, . . . , N + 1 s
i:
sp
1= 0 , . . . , sp
j= l
j−1l
N, . . . , sp
N+1= 1
<
l
j 1 j+1? l
1= -
2−
1- , . . . , l
j= l
j−1+ -
j+1−
j- , . . . , l
N= l
N−1+ -
1−
N−1- @
!5 0 5
!5 0 5
X
Y
Q∗G= 0.586
!5 0 5
!5 0 5
X
Y
Q∗G= 0.657
!5 0 5
!5 0 5
X
Y
Q∗G= 0.768
!4 !2 0 2 4
!4
!3
!2
!1 0 1 2 3
X
Y
Q∗G= 0.464
!4 !2 0 2 4
!3
!2
!1 0 1 2 3
X
Y
Q∗G= 0.636
!4 !2 0 2 4
!3
!2
!1 0 1 2 3
X
Y
Q∗G= 0.754
∆
∗g1
R
2 1 g(
11,
12,
g) R
2(
1,
2,
"3)
1
: #
ni=1
(a
i1 i1+ a
i2 i2) = −δ
1#
ni=2
(
i−
1) × (a
i1 i1+ a
i2 i2) =
(a
i1" 0, a
i2" 0, δ > 0)
!
!!
"!
#"!
#""
#
"##
$#
#$
"!
!!
"!!
""#
!
#$$
#
$%#!
"#
%$
$1
2 3 g 1
g 11
−
12
"
3
"
g 11 12
−
1δ
g
r
max: #
ni=1
(x
i1 i1+ x
i2 i2) = −
1#
ni=2 i
× (x
i1 i1+ x
i2 i2) = (x
i1" 0, x
i2" 0)
i
=
i−
1r
maxx
i1= a
i1δ x
i2= a
i2δ
min
=(x11,x12,···,···,xn1,xn2)T
?
T: = , " @
A (3 × 2n) (3 × 1)
A =
11 12 21 22
· · ·
n1 n20 0 t
21t
22· · · t
n1t
n2
, =
−
10
t
ij=
i×
ij(i = 1, . . . , n ; j = 1, 2)
(
1,
2,
3)
−
111 12
ij
(i .= 1 ; j = 1, 2)
11 12
n 1
T ∗
−
n
i
n
T ∗
r
ballr
ball0 5 10 15 20 25 30 35 0
0.1 0.2 0.3 0.4 0.5 0.6 0.7
fTx∗ rball
T ∗
r
ballR
6n
R
6R
3R
3R
31 2
a b (a, b) " 0
1 2
1
, , ,
1 11 2 2 1 2
ψ
1
= a ;
2= b [cos(ψ) − sin(ψ) ] ;
2= l
1 2
a b ψ
!
$!
!
"
$"
%"
#
$"%
&
%#
'
"
$
"(
ψ a b
= ×
/ 1- -
2/1 1
2 1
= [a + b cos(ψ)] − b sin(ψ)
/1
= l b [sin(ψ) + cos(ψ) ]
/
/
= a b l sin(ψ) a
2+ b
2+ 2 a b cos(ψ)
x
x =
1· = l b [b + a cos(ψ)]
a
2+ b
2+ 2 a b cos(ψ)
ψ x
a b 0 ! cos(ψ) ! 1 x
lb2
a2+b2
! x !
l(b2+ab)
(a+b)2
a b
&
!!"#$#%&'()&
!!"#$#%*'()&
!!"#$#%+'()&
!!"#$#'()&
!!"#$#%,'()&
"−
π2! ψ !
π2
1 2
0 ! x ! l
1 2
ψ ∈ =
−
π2, 0 >
−1 ! cos(ψ) ! 0
x A
lb
b−a
,
a2lb2+b2
B x
l
ψ = −150
◦cos(ψ) = −1
1 2
x =
b−alb[0, l] a b
x β
1 2
1 2
β
ψ a b
tan(β) = b sin(ψ) a + b cos(ψ)
1
2
β ∈ [0, ψ]
x β
x = l(cot(β ) cot(ψ) + 1) 1 + cot
2(β)
&!!"#$#%!"#$%
&
"!
π
2
< ψ <
3π20 10 20 30 40 50 60 70 80 90 100 110 120 130 140 150 160 170
−3
−2
−1 0 1 2 3 4
β
!
"!"#"$%& !"#"'%& !"#"(%& !"#")%& !"#"*%& !"#"+%& !"#",%& !"#"-%& !"#".%& !"#"$%%& !"#"$$%& !"#"$'%& !"#"$(%& !"#"$)%& !"#"$*%& !"#"$+%& !"#"$,%&
x β
ψ l = 1
x β
ψ l = 1
ψ
π2< ψ < π x
l cot
2(ψ) 2 A C
cot
2(ψ) + 1 − 1 B ! x ! −l cot
2(ψ) 2 A C
cot
2(ψ) + 1 + 1 B
1 2
β
M 11 2
x β
Mi
R
31
= [2, 0, 0]
T;
2= [0, 1.5, 0]
T;
3= [0, 0, 2]
T;
4= [1.2, −2, 0]
T1
= [1, 0, 0]
T;
2= [0, 1, 0]
T;
3= [0, 0, 1]
T;
4= [0, −1, 0]
Tµ ! 0.3
R
3µ = 0.5
R
3# ! & ' ( &
#
&
#
!
&
!
"
#
$
&%
$
'$
$
!µ = 0.3
# ! & '
( &
#
&
#
!
&
!
"
#
$
!"
#"
"
µ = 0.5
m
n
i
g
=
n
"
i=1 m
"
j=1
a
ij ij;
ij= [
ij,
i×
ij]
T; a
ij" 0
ij
m
R
6nm
ijg
=
D #
ni=1
#
mj=1
a
ij ij=
#
n i=1#
mj=1 i
× a
ij ij= ; a
ij" 0
k
D #
ni=1
#
mj=1
a
ij ij= − #
mj=1
a
kj kj#
n i=1#
mj=1
(
i−
k) × a
ij ij=
; i .= k , a
ij" 0
g
∆
k k k= #
mj=1
a
kj kjk
∆
r r r=
#
ni=1
#
mj=1
a
ij iji .= k
k
∆
r kn
n n − 1
i*=k
∆
r∆
k kR
3R
3R
3R
3k
k
−
k kR
31
k = 1 D #
ni=1
#
mj=1
a
ij ij= −
1#
ni=2
#
mj=1
(
i−
1) × a
ij ij= ; a
ij" 0
i
2
1 11
1