...
=
4443 424 1
3433 323 1
24 2 322 21
1413 121 1
aaaa
aaaa
aaaa
aaaa
A
thì : dt
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
dA
44
43
424 1
3433 323 1
24
23
22 21
14
13
121 1
=
... 1) / 2 = (0 + 0 + 0 - 1) / 2 = -1 / 2
TS. Phạm Đăng Phớc
Robot công nghiệp
19
sin =
1
2
(O - a ) + (a...
...
=
4443 424 1
3433 323 1
24 2 322 21
1413 121 1
aaaa
aaaa
aaaa
aaaa
A
thì : dt
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
t
a
dA
44
43
424 1
3433 323 1
24
23
22 21
14
13
121 1
=
... 1) / 2 = (0 + 0 + 0 - 1) / 2 = -1 / 2
TS. Phạm Đăng Phớc
Robot công nghiệp
19
sin =
1
2
(O - a ) + (a...
...
C
23 4
C
5
C
6
- S
23 4
S
6
-C
23 4
C
5
S
6
- S
23 4
C
6
C
23 4
S
5
C
23 4
a
4
+C
23
a
3
+C
2
a
2
S
23 4
C
5
C
6
+ C
23 4
S
6
-S
23 4
C
5
S
6
+ C
23 4
C
6
S
23 4
S
5
S
23 4
a
4
+S
23
a
3
+S
2
a
2
-S
5
C
6
S
5
S
6
C
5
0 ... nhất T :
+ Ma trận
2
T
3
= A
3
+ Ma trận
1
T
3
= A
2
.
2
T
3
C
2
0 -S
2
0 1 0 0 0 C
2
0 -S
2
-S
2
*d
3
1
T
3
= S
2
0...
... xứng :
2
)q(q
)
2
t
(q
f0f
+
=
Suy ra
2
t
v
2
)q(q
f
0
f0
+=
+
Vậy
2
)vtq(q
ff0
0
+
=
Phơng trình quỹ đạo tuyến tính sẽ là :
TS. Phạm Đăng Phớc
Robot công nghiệp
97
vt
2
vtqq
(t)q
f0f
i
+
+
= ... Robot công nghiệp
92
Chơng VIII
Thiết kế quĩ đạo robot.
(Trajectory Planing)
Trong các ứng dụng công nghiệp của robot, ta thờng gặp hai...
... B -20 0 sẽ điều khiển thân robot quay sang phải một góc :
1
= (26 1
o
/2) x 20 0 / 511 51
0
04
Lệnh C +20 0 sẽ điều khiển cánh tay robot quay lên phía trên một góc :
3
= (24 9
o
/2) x 20 0 ... Phớc
Robot công nghiệp
64
5.4 .2. Kiểu dữ liệu và khai báo biến trong ASPECT :
a) Kiểu dữ liệu : ASPECT cung cấp các kiểu dữ liệu nh sau :
integer (kiểu nguyên...
... Robot Công nghiệp
1
Chơng I
Giới thiệu chung về robot công nghiệp
1.1. Sơ lợt quá trình phát triển của robot công nghiệp (IR : Industrial Robot) :
Thuật ngữ Robot xuất ...
TS. Phạm Đăng Phớc
Robot Công nghiệp
3
1.3. Các khái niệm và định nghĩa về robot công nghiệp :
1.3.1. Định nghĩa robot công nghiệp :
Hiện nay có nhiều định nghĩa v...
...
C
23 4
C
5
C
6
- S
23 4
S
6
-C
23 4
C
5
S
6
- S
23 4
C
6
C
23 4
S
5
C
23 4
a
4
+C
23
a
3
+C
2
a
2
S
23 4
C
5
C
6
+ C
23 4
S
6
-S
23 4
C
5
S
6
+ C
23 4
C
6
S
23 4
S
5
S
23 4
a
4
+S
23
a
3
+S
2
a
2
-S
5
C
6
S
5
S
6
C
5
0 ... nhất T :
+ Ma trận
2
T
3
= A
3
+ Ma trận
1
T
3
= A
2
.
2
T
3
C
2
0 -S
2
0 1 0 0 0 C
2
0 -S
2
-S
2
*d
3
1
T
3
= S
2
0...
... Robot Công nghiệp
1
Chơng I
Giới thiệu chung về robot công nghiệp
1.1. Sơ lợt quá trình phát triển của robot công nghiệp (IR : Industrial Robot) :
Thuật ngữ Robot xuất ...
TS. Phạm Đăng Phớc
Robot Công nghiệp
3
1.3. Các khái niệm và định nghĩa về robot công nghiệp :
1.3.1. Định nghĩa robot công nghiệp :
Hiện nay có nhiều định nghĩa v...
...
G(s)
)KKfRJs(sR
KKsKK
)KKfRJs(sR
)sK(KK
E(s)
(s)θ
baaa
pva
baaa
vpa
L
=
++
+
=
++
+
=
a
(9 .24 )
Tõ ®ã ta cã :
pavabaaa
2
pva
L
L
KK)KKKKfs(RJRs
)Ks(KK
G(s)1
G(s)
(s)θ
~
(s)θ
++++
+
=
+
= (9 .25 )
TS. Ph¹m §¨ng Ph−íc
robot công nghiệp
99
Chơng 9
Truyền ... giải tinh hơn nhiều. Ví dụ, nếu phân 125 bớc nhỏ trong một bớc đầy,
với 20 0 bớc/vòng thì độ phân giải của động...
... a
3
+ S
2
a
2
)
2
p
2
x
+ p
2
y
= (S
2
23
+ C
2
23
)a
2
3
+ (S
2
2
+ C
2
2
)a
2
2
+ 2 a
2
a
3
(C
23
C
2
+ S
23
S
2
)
Ta có C
23
C
2
+ S
23
S
2
= cos(
2
+
3
-
2
) = cos
3
...
C
23 4
C
5
C
6
- S
23 4
S
6
-C
23 4
C
5
S
6
- S
23 4
C
6
C
23 4
S
5
C
23 4
a
4
+C
23
a
3
+C
2
a
2
S
23 4
C
5
C
6
+ C
23 4
S
6
-S
23 4
C
5
S...