Documentos de Académico
Documentos de Profesional
Documentos de Cultura
CARRERA DE
X INGENIERÍA MECÁNICA
INGENIERÍA MECATRÓNICA
INTEGRANTES
ACURIO ALVAREZ JOHNNY ROLANDO
AVILA NAVARRETE JOSE EDUARDO
BALSECA TORRES MARTIN ALEJANDRO
CHERRES ARAUZ JONATHAN DANIEL
FREIRE SINCHIGUANO ERIK ISMAEL
FECHA 24/07/2021
INDICE GENERAL
...........................................................................................................................................................1
........................................................................................................6
....................................................................7
....................................................................................................................8
................................................................................................................8
..............................................................................................................8
..........................................................................................................9
................................................................10
............................................................................................................10
..................................................................................................................10
..............................................................................................................10
............................................................................................................11
........................................................................................................11
......................................................12
..............................................................................................................13
..............................................................................................................13
.........................................................................................................13
........................................................................................................14
..............................................................................................................15
..............................................................................................................15
............................................................................................................16
........................................................................................................17
...........................................................................................................18
..............................................................................................................18
............................................................................................................19
........................................................................................................19
................................................................................................20
.................................................................................................................20
..............................................................................................................................21
....................................................................................................................................22
...............................................................................................................................23
....................................................................................................................................24
............................................................24
...............................................25
𝑙𝐺2 .....................................................................................................26
𝑙𝐺3 ....................................................................................................26
𝑙𝐺5 ....................................................................................................26
....................................................................................27
..............................................................................................27
...............................................................................................28
...................................................................................................31
.......................................................................................................32
..........................................................................................................................32
...........................................................................................................................33
...........................................................................................................................................................1
........................................................................................................8
....................................................................9
..................................................................................................................10
..............................................................................................................10
............................................................................................................10
........................................................................................................11
................................................................12
............................................................................................................12
..................................................................................................................12
..............................................................................................................12
............................................................................................................13
........................................................................................................13
......................................................14
..............................................................................................................15
..............................................................................................................15
.........................................................................................................15
........................................................................................................16
..............................................................................................................17
..............................................................................................................17
............................................................................................................18
........................................................................................................19
...........................................................................................................20
..............................................................................................................20
............................................................................................................21
........................................................................................................21
................................................................................................22
.................................................................................................................22
..............................................................................................................................23
....................................................................................................................................24
...............................................................................................................................25
....................................................................................................................................26
............................................................26
...............................................27
𝑙𝐺2 .....................................................................................................28
𝑙𝐺3 ....................................................................................................28
𝑙𝐺5 ....................................................................................................28
....................................................................................29
..............................................................................................29
...............................................................................................32
...................................................................................................33
.......................................................................................................34
..........................................................................................................................34
Gomparacion de Graficas................................................................................36
𝑚 = 3(6 − 1) − 7(2) = 1
𝑁 = 𝑗−𝑐 = 7−5= 2
R3BC
R2
R1
R2 R5
R6
R1_
𝐶𝑜𝑛𝑠𝑡𝑎𝑛𝑡𝑒𝑠
𝑟2 ∗ sin(𝜃2 )
𝜃3𝐵𝐶 = tan−1 ( )
𝑟1 + 𝑟2 ∗ cos(𝜃2 )
𝑟2 ∗ sin(𝜃2 )
𝑟3𝐵𝐶 =
sin(𝜃3𝐵𝐶 )
𝑟2 ∗ 𝜔2 ∗ cos(𝜃2 − 𝜃3𝐵𝐶 )
𝜔3𝐵𝐶 =
𝑟3𝐵𝐶
Aceleración 𝛼2 = 0 𝛼5 , 𝑎6
Tabla 2 Constantes, variables conocidas e incógnitas para el lazo OBAEP
⃗⃗⃗⃗6 + 𝑅
𝑅 ⃗⃗⃗⃗2 + ⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝑅3𝐴𝐵 − 𝑅 ⃗⃗⃗⃗5 − ⃗⃗⃗⃗⃗⃗
𝑅1− = 0
𝑟2 ∗ 𝜔2 ∗ cos(𝜃2 − 𝜃5 ) + 𝑟3 ∗ 𝜔3 ∗ sin(𝜃3𝐴𝐵 − 𝜃5 )
𝜔5 =
sin(𝜃5 )
+ 𝑟5 ∗ 𝜔5 2 ∗ cos(𝜃5 ) + 𝑟5 ∗ 𝛼5 ∗ sin(𝜃5 ) = 0
𝑎6 − 𝑟2 ∗ 𝜔2 2 ∗ sin(𝜃2 ) + 𝑟2 ∗ 𝛼2 ∗ cos(𝜃2 ) − 𝑟3𝐴𝐵 ∗ 𝜔3𝐴𝐵 2 ∗ sin(𝜃3𝐴𝐵 ) + 𝑟3𝐴𝐵 ∗ 𝛼3𝐴𝐵
𝐺2 , 𝐺3 , 𝐺5
𝑅2
𝑟21𝑥 (𝜃2 ) = ∗ cos(𝜃2 )
2
𝑅2
𝑟21𝑦 (𝜃2 ) = ∗ sin(𝜃2 )
2
0.02 0.02
0.01 0.01
( )
r21x 2 0 0 ( )
r21y 2
− 0.01 − 0.01
− 0.02 − 0.02
0 100 200 300 400 500
180
2
𝑟21𝑥 𝑟21𝑦
𝑅2
𝑣𝐺2𝑥 (𝜃2 ) = − ∗ 𝜔2 ∗ 𝑠𝑖𝑛(𝜃2 )
2
𝑅2
𝑣𝐺2𝑦 (𝜃2 ) = ∗ 𝜔2 ∗ 𝑐𝑜𝑠(𝜃2 )
2
1 1
0.5 0.5
( )
VG2x 2 0 0 VG2y 2( )
− 0.5 − 0.5
−1 −1
0 100 200 300 400 500
180
2
𝑣𝐺2𝑥 𝑣𝐺2𝑦
𝑅2
𝑎𝐺2𝑥 (𝜃2 ) = − ∗ 𝜔2 2 ∗ 𝑐𝑜𝑠(𝜃2 )
2
𝑅2
𝑎𝐺2𝑦 (𝜃2 ) = − ∗ 𝜔2 2 ∗ 𝑠𝑖𝑛(𝜃2 )
2
60 60
40 40
20 20
( )
aG2x 2 0 0 ( )
aG2y 2
− 20 − 20
− 40 − 40
− 60 − 60
0 100 200 300 400 500
180
2
𝑎𝐺2𝑥 𝑎𝐺2𝑦
𝑅2 ∗ sin(𝜃2 )
𝜃3 (𝜃2) = tan−1( )
𝑅1 + 𝑅2 ∗ cos(𝜃2 )
𝑅2 ∗ sin(𝜃2 )
𝑟3𝐵𝐶 (𝜃2 ) =
sin(𝜃3 (𝜃2 ))
𝑅2 ∗ 𝜔2 ∗ cos(𝜃2 − 𝜃3 (𝜃2))
𝜔3𝐵𝐶 (𝜃2 ) =
𝑟3𝐵𝐶 (𝜃2 )
𝑉𝐺3𝑥 (𝜃2 ) = −𝑅𝐺3 (𝜃2 ) ∗ 𝜔3𝐵𝐶 (𝜃2 ) ∗ 𝑠𝑖𝑛(𝜃3 (𝜃2 )) + 𝑣3𝐵𝐶 (𝜃2 ) ∗ 𝑐𝑜𝑠(𝜃3 (𝜃2 ))
𝑉𝐺3𝑦 (𝜃2 ) = 𝑅𝐺3 (𝜃2 ) ∗ 𝜔3𝐵𝐶 (𝜃2 ) ∗ 𝑐𝑜𝑠(𝜃3 (𝜃2 )) + 𝑣3𝐵𝐶 (𝜃2 ) ∗ 𝑠𝑖𝑛(𝜃3 (𝜃2 ))
𝑅𝐺3𝑥 𝑅𝐺𝑦
𝑅2 ∗ 𝜔2 2 ∗ sin(𝜃2 − 𝜃3 (𝜃2)) + 2 ∗ 𝑣3𝐵𝐶 (𝜃2 ) ∗ 𝜔3𝐵𝐶 (𝜃2)
𝛼3𝐵𝐶 (𝜃2) = −
𝑟3𝐵𝐶 (𝜃2)
𝑎𝐺3𝑥 (𝜃2 ) = −𝑅𝐺3 (𝜃2 )(𝛼3𝐵𝐶 (𝜃2 ) ∗ 𝑠𝑖𝑛(𝜃3 (𝜃2 )) + 𝜔3𝐵𝐶 (𝜃2 )2 ∗ 𝑐𝑜𝑠(𝜃3 (𝜃2 ))) − 𝑣3𝐵𝐶 (𝜃2 )
∗ 𝜔3𝐵𝐶 (𝜃2 ) ∗ 𝑠𝑖𝑛(𝜃3 (𝜃2 )) + 𝑎3𝐵𝐶 (𝜃2 ) ∗ 𝑐𝑜𝑠(𝜃3 (𝜃2 )) − 𝑣3𝐵𝐶 (𝜃2 ) ∗ 𝜔3𝐵𝐶 (𝜃2 )
∗ 𝑠𝑖𝑛(𝜃3 (𝜃2 ))
𝑎𝐺3𝑦 (𝜃2 ) = −𝑅𝐺3 (𝜃2 )(𝛼3𝐵𝐶 (𝜃2 ) ∗ 𝑐𝑜𝑠(𝜃3 (𝜃2 )) − 𝜔3𝐵𝐶 (𝜃2 )2 ∗ 𝑠𝑖𝑛(𝜃3 (𝜃2 ))) + 𝑣3𝐵𝐶 (𝜃2 )
∗ 𝜔3𝐵𝐶 (𝜃2 ) ∗ 𝑐𝑜𝑠(𝜃3 (𝜃2 )) + 𝑎3𝐵𝐶 (𝜃2 ) ∗ 𝑠𝑖𝑛(𝜃3 (𝜃2 )) + 𝑣3𝐵𝐶 (𝜃2 ) ∗ 𝜔3𝐵𝐶 (𝜃2 )
∗ 𝑐𝑜𝑠(𝜃3 (𝜃2 ))
𝑎𝐺3𝑥 𝑎𝐺3𝑦
−𝑟1− + 𝑅2 ∗ cos(𝜃2 ) + 𝑟3𝐴𝐵 ∗ cos(𝜃3 (𝜃2 ))
𝜃5 (𝜃2 ) = cos −1 ( )
𝑟5
𝑟𝐺5𝑥 𝑟𝐺5𝑦
𝑅2 ∗ 𝜔2 ∗ sin(𝜃2 ) + 𝑟3𝐵𝐶 ∗ 𝜔3𝐵𝐶 (𝜃2 ) ∗ sin(𝜃3 (𝜃2 ))
𝜔5 (𝜃2 ) =
𝑟5 ∗ sin(𝜃5 (𝜃2 ))
2 4
1.5 2
( )
VG5x 2 1 0 VG5y 2( )
0.5 −2
0 −4
0 100 200 300 400 500
180
2
𝑣𝐺5𝑥 𝑣𝐺5𝑦
𝑅2 𝜔2 2 ∗ cos(𝜃2 ) + 𝑟3𝐴𝐵 𝜔3𝐵𝐶 2 ∗ cos(𝜃3 (𝜃2 )) − 𝑟5 𝜔5 (𝜃2 )2 + 𝑟3𝐴𝐵 𝛼3𝐵𝐶 (𝜃2 ) sin(𝜃3 (𝜃2 ))
𝛼5 (𝜃2 ) =
𝑟5 − sin(𝜃5 (𝜃2 ))
𝑎𝐺5𝑥 (𝜃2 ) = −𝑅5− ∗ (𝛼5 (𝜃2 ) ∗ 𝑠𝑖𝑛(𝜃5 (𝜃2 ) + 𝜔5 (𝜃2 )2 ∗ 𝑐𝑜𝑠(𝜃5 (𝜃2 )))
𝑎𝐺5𝑦 (𝜃2 ) = 𝑎6 (𝜃2 ) + 𝑅5− ∗ (𝛼5 (𝜃2 ) ∗ 𝑐𝑜𝑠(𝜃5 (𝜃2 ) − 𝜔5 (𝜃2 )2 ∗ 𝑠𝑖𝑛(𝜃5 (𝜃2 )))
60 200
40
100
20
( )
aG5x 2 0 0 ( )
aG5y 2
− 20
− 100
− 40
− 60 − 200
0 100 200 300 400 500
180
2
𝑎𝐺5𝑥 𝑎𝐺5𝑦
⃗𝑭𝟐𝟑𝒚
⃗ 𝟐𝟑𝒙
𝑭
⃗ 𝑮𝟐𝒚
𝒎𝟐 𝒂
𝑅⃗23
𝑰𝑮𝟐 𝜶𝟐
⃗ 𝑮𝟐𝒙
𝒎𝟐 𝒂
𝑅⃗2
⃗𝑭𝟐𝟏𝒚 𝑅⃗21
⃗ 𝟐𝟏𝒙
𝑭
⃗⃗⃗
𝑴𝟐𝟏
∑𝐹 = 𝑚2 ⃗⃗⃗⃗⃗⃗
𝑎𝐺2
∑𝑀𝑜 = 𝐼𝑜 ⃗⃗⃗⃗⃗
∝2
𝑅⃗2 ⨂𝐹23 + 𝑀
⃗⃗ 21 = 𝐼𝑜 𝛼2
𝑖 𝑗 𝑘
𝑟
| 2𝑥 𝑟2𝑦 ⃗⃗ 21 = 0
0| + 𝑀
𝐹23𝑥 𝐹23𝑦 0
⃗𝑭𝟑𝟓𝒙
𝑅⃗3
⃗ 𝑮𝟑𝒚
𝒎𝟑 𝒂
⃗𝑭𝟑𝟐𝒚
𝑅⃗35
⃗𝑭𝟑𝟐𝒙
𝑰𝑮𝟑 𝜶𝟑
𝑅⃗34
⃗ 𝑮𝟑𝒙
𝒎𝟑 𝒂
𝜽𝟑 + 𝟐𝟕𝟎°
⃗𝑭𝑵𝑪
⃗ 𝑮𝟑
∑𝑭 = 𝒎𝟑 𝒂
𝑖 𝑗 𝑘 𝑖 𝑗 𝑘
| 𝑟35𝑥 𝑟35𝑦 0| + | 𝑟32𝑥 𝑟32𝑦 0| +
𝐹35𝑥 𝐹35𝑦 0 −𝐹23𝑥 −𝐹23𝑦 0
𝑖 𝑗 𝑘
| 𝑟𝑁𝐶𝑥 𝑟𝑁𝐶𝑦 0| = 𝐼63 ⃗⃗⃗⃗⃗
∝3
−𝐹𝑁𝐶𝑥 −𝐹𝑁𝐶𝑦 0
𝑟35𝑥 𝐹35𝑦 − 𝑟35𝑦 𝐹35𝑥 − 𝑟32𝑥 𝐹23𝑦 + 𝑟32𝑦 𝐹23𝑥 − 𝑟𝑁𝐶𝑥 𝐹𝑁𝐶𝑦 + 𝑟𝑁𝐶𝑦𝐹𝐶𝑁𝑥 = 𝐼𝐺3 ∝3 (6)
⃗ 𝑵𝑪
𝑭
⃗𝑭𝟒𝟑𝒙 𝜽𝟑 + 𝟗𝟎°
⃗ 𝟒𝟑𝒚
𝑭
∑𝐹 = 𝑚4 𝑎4
⃗ 𝟓𝟑𝒚
𝑭
⃗ 𝑮𝟓𝒚
𝒎𝟓 𝒂
⃗ 𝑮𝟓𝒙
𝒎𝟓 𝒂
𝑰𝑮𝟓 𝜶𝟓
⃗𝑭𝟓𝟔𝒚
⃗𝑭𝟓𝟔𝒙
∑𝐹 = 𝑚5 𝑎𝐺5
∑𝑀 = 𝐼𝐺5 ∝5
⃗⃗⃗⃗⃗⃗
𝑅53 ⨂𝐹 ⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗
53 + 𝑅56 ⨂𝐹56 = 𝐼𝐺5 ∝5
⃗⃗⃗⃗⃗⃗
𝑅 ⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗ ⃗⃗⃗⃗⃗⃗
53 ⨂(−𝐹35 ) + 𝑅56 ⨂𝐹56 = 𝐼𝐺5 ∝5
𝑖 𝑗 𝑘 𝑖 𝑗 𝑘
𝑟
| 53𝑥 𝑟53𝑦 0| + | 𝑟56𝑥 𝑟56𝑦 0| = 𝐼𝐺5 ∝5
−𝐹35𝑥 −𝐹35𝑦 0 𝐹65𝑥 𝐹56𝑦 0
−𝑟53𝑥 𝐹35𝑦 + 𝑟53𝑦 𝐹35𝑥 + 𝑟56𝑥 𝐹56𝑦 − 𝑟56𝑦 𝐹56𝑥 = 𝐼𝑔6 ∝6 (11)
⃗𝑭𝟔𝟓𝒚
⃗ 𝟔𝟓𝒙
𝑭
⃗𝑭𝑵𝑪𝒙
⃗𝟔
𝒎𝟔 𝒂
∑𝑭 = 𝒎𝟔 𝒂𝟔
𝐹65 + 𝐹61 = 𝑚6 𝑎6
𝐹65 = −𝐹56
−𝐹65𝑦 = 𝑚6 𝑎6 (13)
( ) ( )
r2y 2 = r2 sin 2 ( ) ( ( )) ( ( ))
r34y 2 = r34 3 2 sin 3 2 ( ) ( ( ))
r35y 2 = r35 sin 3 2
( ) ( ( )) ( ( ))
r34x 2 = r34 3 2 cos 3 2 ( ) ( ( ))
r35x 2 = r35 cos 3 2
( ) ( )
r2x 2 = r2 cos 2
x(2) = cos (3(2) + 270) ( ) ( ( ))
r56y 2 = r56 sin 5 2
( ) ( ( ))
r32y 2 = r32 sin 3 2 y(2) = sin(3(2) + 270)
( ) ( ( ))
r56x 2 = r56 cos 5 2
( ) ( ( ))
r32x 2 = r32 cos 3 2 ( ) ( ( ) )
x1 2 = cos 3 2 + 90
𝑘𝑔
ρ𝑎𝑐𝑒𝑟𝑜 = 8000 l𝑂𝐵 = 0.03m l4D = 0.15m lAE = 0.08m
𝑚3
𝑚
𝜌𝑎𝑐𝑒𝑟𝑜 = 𝑚 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝑣
𝑣
𝑣 = 𝜋 ∗ 𝑅2 ∗ ℎ
𝑚 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝜋 ∗ 𝑅2 ∗ ℎ
1
𝐼𝑜 = 𝑚 𝑙2
12 0∗ 0
𝑙𝐺2
2
𝑚𝑂𝐵 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝜋 ∗ 𝑅𝑂𝐵 ∗ 𝑙𝑂𝐵
𝑚𝑂𝐵 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝜋 ∗ (𝑟)2 ∗ 𝑙𝑂𝐵
𝑘𝑔
𝑚𝑂𝐵 = 8000 ∗ 𝜋 ∗ (0.01𝑚)2 ∗ (0.03𝑚) = 0.0753𝐾𝑔
𝑚3
1
𝐼𝑂𝐵 = 𝑚 𝑙2
12 𝑂𝐵∗ 𝑂𝐵
1
𝐼𝑂𝐵 = (0.0752 𝐾𝑔)(0.03𝑚)2 = 0.00000564 𝐾𝑔 ∗ 𝑚2
12
𝑙𝐺3
2
𝑚𝐴𝐷 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝜋 ∗ 𝑅𝐴𝐷 ∗ 𝑙𝐴𝐷
𝑚𝐴𝐷 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝜋 ∗ (𝑟)2 ∗ 𝑙𝐴𝐷
𝑘𝑔
𝑚𝐴𝐷 = 8000 3
∗ 𝜋 ∗ (0.01𝑚)2 ∗ (0.15𝑚) = 0.3769𝐾𝑔
𝑚
1 2
𝐼𝐴𝐷 = 12 𝑚𝐷∗ 𝑙𝐴𝐷
1
𝐼𝐴𝐷 = 12 (0.3769 𝐾𝑔)(0.15𝑚)2 = 0.0007066 𝐾𝑔 ∗ 𝑚2
𝑙𝐺5
2
𝑚𝐴𝐸 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝜋 ∗ 𝑅𝐴𝐸 ∗ 𝑙𝐴𝐸
𝑚2 = 𝜌𝑎𝑐𝑒𝑟𝑜 ∗ 𝜋 ∗ (𝑟)2 ∗ 𝑙𝐴𝐸
𝑘𝑔
𝑚𝐴𝐸 = 8000 3
∗ 𝜋 ∗ (0.01𝑚)2 ∗ (0.08𝑚) = 0.2010 𝐾𝑔
𝑚
1
𝐼𝐴𝐸 = 𝑚 𝑙2
12 𝐴𝐸∗ 𝐴𝐸
1
𝐼𝐴𝐸 = (0.2010 𝐾𝑔)(0.08𝑚)2 = 0.0001072 𝐾𝑔 ∗ 𝑚2
12
[𝐺 ] ⋅ {𝐹𝑖𝑗 } = {𝐹𝑒𝑓 }
m
1 0 0 1 0 0 0 0 0 0 0 0 0
0 1 0 0 1 0 0 0 0 0 0 0 0
m
0 0 1 −r2y( 2) r2x( 2) 0 0 0 0 0 0 0 0
0 0 0 −1 0 1 0 x( 2) 1 0 0 0 0
m
0 0 0 0 −1 0 1 y ( 2) 0 1 0 0 0 m
I
0 0 0 r32y( 2) −r32x( 2) −r34y( 2) r34x( 2) 0 −r35y( 2) cos ( 3( 2) + 270) r35x( 2) sin ( 3( 2) + 270) 0 0 0 G
Fef ( 2) =
Ma ( 2) = 0 −1 −x1( 2)
0 0 0 0 0 0 0 0 0 0
0 0 0 0 0 0 −1 y 1( 2) 0 0 0 0 0
m
0 0 0 0 0 0 0 0 −1 0 1 0 0 m
0 0 0 0 0 0 0 0 0 −1 0 1 0
I
0 0 0 0 0 0 0 0 −r35y( 2) r35x( 2) −r56y( 2) r56x( 2) 0
0 0 0 0 0 0 0 0 0 0 −1 0 1
m
0 0 0 0 0 0 0 0 0 0 0 −1 0
GRAFICAS:
FNC
F35x y F35Y
𝐹𝑆𝑋
𝐹𝑆𝑋 = −𝐹34𝑋 −𝐹21𝑋 − 𝐹𝑁𝐶𝑋
𝐹𝑆𝑌 = 𝛴𝐹𝑌
𝐹𝑆𝑌 = 𝐹13𝑌 + 𝐹12𝑌
𝐹13𝑌 = −𝐹34𝑌 𝐹12𝑌 = −𝐹21𝑌
𝐹𝑆𝑌
𝐹𝑆𝑌 = −𝐹34𝑌 −𝐹21𝑌
𝐹𝑆 = √𝐹𝑆𝑋 2 + 𝐹𝑆𝑌 2
𝑀𝑆 = −𝑀12 + 𝑅1 ∗ 𝐹13𝑦
𝑀𝑆
𝑀𝑆 = 𝑀21 − 𝑅1 ∗ 𝐹34𝑦
⃗𝑹
⃗𝟐
⃗⃗⃗⃗⃗
𝑅𝐵 = 𝑅⃗⃗⃗⃗2
𝑟𝑏𝑥 𝑟𝑏𝑦
⃗⃗⃗⃗
𝑅𝐴 = ⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝑅3𝐶𝐵 + ⃗⃗⃗⃗⃗⃗⃗⃗⃗
𝑅3𝐴𝐵
𝑟𝐴𝑦 = 𝑟3𝐵𝐶 (𝜃2 ) ∗ sin(𝜃3 (𝜃2 )) + 𝑟3𝐴𝐵 ∗ sin(𝜃3 (𝜃2 ))
𝑟𝑎𝑥 𝑟𝑎𝑦
𝜃3 (𝜃2 ) 𝜃3𝐴𝑆 (𝜃2) 𝑟3𝐵𝐶 (𝜃2 )
𝑣6 (𝜃2 ) 𝜔5 (𝜃2 )
𝑎6 (𝜃2 ) 𝛼5 (𝜃2 )
𝑎6 (𝜃2 ) 𝛼5 (𝜃2 )
0.02 0.02
0.01 0.01
( )
r21x 2 0 0 ( )
r21y 2
− 0.01 − 0.01
− 0.02 − 0.02
0 100 200 300 400 500
180
2
𝑟𝐺2𝑥 𝑟𝐺2𝑦
𝑟𝐺2𝑥 𝑟𝐺2𝑦
1 1
0.5 0.5
( )
VG2x 2 0 0 VG2y 2 ( )
− 0.5 − 0.5
−1 −1
0 100 200 300 400 500
180
2
0.08 0.03
0.02
0.06
0.01
( )
RG3x 2 0.04 0 ( )
RG3y 2
− 0.01
0.02
− 0.02
0 − 0.03
0 100 200 300 400 500
180
2
1
1
( )
VG3x 2 0 VG3y 2( )
0
−1
−2 −1
0 100 200 300 400 500
180
2
150 100
100 50
( )
aG3x 2
50
0 ( )
aG3y 2
0
− 50 − 50
− 100 − 100
0 100 200 300 400 500
180
2
2 4
1.5 2
( )
VG5x 2 1 ( )
0 VG5y 2
0.5 −2
0 −4
0 100 200 300 400 500
180
2
60 200
40
100
20
( )
aG5x 2 0 0 ( )
aG5y 2
− 20
− 100
− 40
− 60 − 200
0 100 200 300 400 500
180
2
𝐹34𝑥 𝐹34𝑦
𝐹34𝑥 𝐹34𝑦
80 20
60 0
40
− 20
( )
F34y 2 20 ( )
F34x 2
− 40
0
− 20 − 60
− 40 − 80
0 100 200 300 400 500
180
2
F34x y F34Y
F34x y F34Y