Tài liệu Robot và điều khiển chuyển động ppt
Bạn đang xem bản rút gọn của tài liệu. Xem và tải ngay bản đầy đủ của tài liệu tại đây (1.95 MB, 82 trang )
ROBOT VÀ ĐIỀU KHIỂN CHUYỂN ĐỘNG
(2 TÍN CHỈ)
1, NguyÔn ThiÖn Phóc, R« bèt c«ng nghiÖp. Nhµ xuÊt
b¶n Khoa häc vµ Kü thuËt, 2002.
2, µo V n HiÖp, R« bèt c«ng nghiÖp. Nhµ xuÊt b¶n Đ ă
Khoa häc vµ Kü thuËt, 2004.
3, T¹ Duy Liªm, R« bèt c«ng nghiÖp. Nhµ xuÊt b¶n
Khoa häc vµ Kü thuËt .
4, NguyÔn M¹nh TiÕn, iÒu khiÓn R« bèt c«ng nghiÖp. Đ
Nhµ xuÊt b¶n Khoa häc vµ Kü thuËt, 2007 .
4, Industrial Robots, Computer Interfacing and
Control Weslvy E. Snyder Prentice Hall 1987.
Tµi liÖu tham kh¶o
Nắm được các cấu trúc robot và điều
khiển chuyển động tay máy. Động học
và động lực học robot. Các bộ phận
truyền động secvo và cảm biến. Thuật
toán điều khiển robot theo quĩ đạo
đặt.
Tạo hình bề mặt trên máy
công cụ điều khiển số
1- Khái niệm.
•
Trên máy công cụ điều khiển theo chương trình số,
đường tác dụng giữa dụng cụ và chi tiết được hình
thành nhờ các dịch chuyển toạ độ trên nhiều trục.
Để sản sinh một biên dạng gia công, giữa các
chuyển động trên từng trục toạ độ riêng lẻ phải có
một quan hẹ hàm số( tuyến tính hoặc phi tuyến).
•
Các điểm tựa phải nằm dày đặc đến mức sao cho
biên dạng gia công tạo ra đủ chính xác ( không có
điểm nào nằm ngoài vùng dung sai cho phép).
•
Giá trị toạ độ vị trí các điểm trung gian được tìm ra
trong một cụm chức năng của điều khiển số- gọi là
bộ nội suy.
Tạo hình bề mặt trên máy
công cụ điều khiển số
1- Khái niệm.
•
Bộ nội suy có nhiệm vụ:
- Tìm ra vị trí các điểm trung gian cho phép hình thành biên
dạng cho trước trong giới hạn dung sai xác định.
- Tốc độ đưa ra vị trí các điểm trung gían phải phù hợp với tốc
độ chạy dao.
- Đi tới chính xác các điểm kết thúc chương trình.
•
Về mặt kỹ thuật, việc nội suy có thể được thực hiện bằng các
thiết bị làm việc theo kiểu số hoặc kiểu tương tự.
- Bộ nội suy kiểu tương tự đơn gỉn nhưng độ chính xác hạn
chế.
- Trên thực tế người ta dùng các bộ nội suy làm việc theo
nguyên tắc số.
Tạo hình bề mặt trên máy
công cụ điều khiển số
•
Nội suy số.
Việc tính toán các hàm số ở dạng số có thể thực hiện theo 2
phươn pháp:
- Tính toán hàm số trực tiếp từ đường cong dạng hàm toán
học: f(x,y,z)=0
Sau mỗi bước nội suy sẽ được kiểm tra sai lệch vị trí thực so
với đường cong để điều chỉnh chuyển động trên các trục.
- Tính toán theo các thông số của đường cong là hàm của thời
gian thực.
- Chuyển các phương trình riêng của hệ sang
phương trình vi phân để tính toán bằng số, sẽ
tìm ra các giá trị chạy dao trên từng tục thông
qua tổng vi phân. Phương pháp này gọi là
phương pháp phân tích vi phân số DDA.
(Digital- Differential- Analyse);
=
=
=
)(
)(
)(
tzz
tyy
txx
Tạo hình bề mặt trên máy
công cụ điều khiển số
2- Các dạng nội suy.
Theo biên dạng nội suy tạo ra, có:
•
Nội suy tuyến tính ( thẳng).
•
Nội suy phi tuyến ( tròn, parabol).
Đối với nội suy thẳng và nội suy vòng:
•
Nội suy thẳng theo 2 trong n trục.
•
Nội suy thẳng theo n trong n trục.
•
Nội suy vòng theo 2 trong n trục.
•
Nội suy vòng theo 2 trong n trục đồng thời với nội
suy thẳng theo một trục vuông góc với mặt phẳng
của đường tròn nội suy (nội suy đường xoắn vít).
Tạo hình bề mặt trên máy
công cụ điều khiển số
2- Phương pháp nội suy.
a-Các hệ CNC thực hiện
nội suy theo hai mức:
•
Nội suy thô: Xác định
toạ độ của các điểm
trung gian giữa điểm
đầu và điểm cuối(P
1
,
P
2
, P
3
,…).
•
Nội suy tinh xác: Thực
hiện nội suy tuyến tính
giữa các điểm trung
gian này.
Giá trị đầu vào
P
1
, P
2
, P
3
…
Nội suy thô
Các điểm trung gian
P
11
, P
12
, P
13
,…
Nội suy tinh
X
i
Y
i
P
1
P
2
P
3
P
11
Tạo hình bề mặt trên máy
công cụ điều khiển số
b- Phương pháp nội suy DDA.
•
Phương pháp nội suy tuyến tính.
A
B
V
X
A
X
B
Y
A
Y
B
X
Y
dt
T
XX
XdtVXtX
t
AB
AXA
∫ ∫
−
+=+=
0
)(
dt
T
YY
YdtVYtY
t
AB
AYA
∫ ∫
−
+=+=
0
)(
V
YYXX
V
L
T
ABXB
AB
22
)()( −+−
==
Tạo hình bề mặt trên máy
công cụ điều khiển số
Chia thời gian T thành các khoảng ∆t=T/N đủ nhỏ.
Thay phép tích phân bằng phép cộng:
X
t
∆X
∆t
X = X(t)
Y
t
∆Y
∆t
Y = Y(t)
n
N
XX
XtX
AB
A
−
+=)(
n
N
YY
YtY
AB
A
−
+=)(
∆+=
∆+=
YnYY
XnXX
An
An
Dữ liệu vào:
X
A
,Y
A
,X
B
,Y
B
,V,∆f
(X
B
-X
A
) ; (Y
B
-Y
A
)
(X
B
-X
A
)>(Y
B
-Y
A
)
N
’
=
Y
B
-Y
A
∆f
N
’
=
X
B
-Y
A
∆f
m>lgN
’
N=10
m
∆X=
X
B
-X
A
∆Y=
Y
B
-Y
A
N
N
;
X
n
=X
A
+Σ∆X ; Y
B
=Y
A
+Σ∆Y
X
n
<X
B
;Y
n
<Y
B
Kết thúc
Bước cộng tiếp theo
(X
B
-X
A
)
2
; (Y
B
-Y
A
)
2
(X
B
-X
A
)
2
- (Y
B
-Y
A
)
2
L=
T=
L
V
∆t =
T
N
; f=
T
∆t
&
X
n
, Y
n
Đúng
Sai
m=1,2,3…
•
Phương pháp nội suy vòng
Phương trình đường tròn.
Gọi T là thời gian chạy hết toàn vòng.
Với ∆t=T/N
R
ϕ
P(x,y)
=
=
ϕ
ϕ
sin
cos
RY
RX
T
t
πϕ
2=
=
=
t
T
RtY
t
T
RtX
π
π
2
sin)(
2
cos)(
=
=
−=
−=
)(
22
cos
2
)(
22
sin
2
tX
T
t
T
R
Tdt
dY
tY
T
t
T
R
Tdt
dX
πππ
πππ
∑
∆−= tY
T
XtX
A
π
2
)(
∑
∆+= tX
T
YtY
A
π
2
)(
∑
=
∆−=
n
i
A
tiY
N
XtX
1
)(
2
)(
π
∑
=
∆+=
n
i
A
tiX
N
YtY
1
)(
2
)(
π
•
Nội suy Parabol
•
Chủ yếu dùng trên các máy nhiều trục(4,5…)
•
Một đường parabol không gian được tạo bởi 3
điểm P
1
, P
2
, P
3
.
P
2
: là điểm giữa của P
1
và P
5
.
P
5
: là điểm giữa của P
1
và P
3
.
P
5
P
4
P
1
P
3
P
2
•
Nội suy ghép nối.
•
Sự nối ghép và chuyển tiếp giứa các đường cong
được thực hiện thông qua các tiếp tuyến.
•
Với kiểu nội suy này các dạng hình học phức tạp
có thể được lập trình bằng cách sử dụng các khối
dữ liệu chương trình ít hơn một cách đáng kể hơn
so với khi sử dụng nội suy thẳng.
Có nhi u, robots, trong băng chuyền, máy gia công CNC, các
tr m s n, h u c n.T i xu ng t qu n lý s n xu t, k t n i v i qu n tr
m ng.
Tự động hóa linh hoạt (FMS)
