Nâng cao chất lượng điều khiển cho robot Scara, chương 5

Chia sẻ: Van Teo | Ngày: | Loại File: PDF | Số trang:5

Thêm vào BST

Báo xấu

321
lượt xem 125
download

Download Vui lòng tải xuống để xem tài liệu đầy đủ

Cấu hình của robot Scara Serpent Bao gồm một chuỗi các thanh cứng được liên kết với nhau bởi các khớp: Cấu hình và các hệ trục tọa độ gắn trên Robot Scara Serpent. Robot Scara Serpent gồm 3 khớp chuyển động quay và một khớp chuyển động tịnh tiến. Gắn cho mỗi thanh nối một hệ trục toạ độ, ta có: - Khớp 1 quay quanh trục z0 góc θ1. - Khớp 2 quay quanh trục z1 góc θ2. - Khớp 3 chuyển động tịnh tiến theo trục z2 đoạn d3. - Khớp 4 quay quanh trục z3 góc θ4. 2.2.1.2....

Chủ đề:

Bình luận(0) Đăng nhập để gửi bình luận!

Lưu

Nội dung Text: Nâng cao chất lượng điều khiển cho robot Scara, chương 5

Chương 5: Cấu tạo tay máy robot Scara Serpent 2.2.1.1. Cấu hình của robot Scara Serpent Bao gồm một chuỗi các thanh cứng được liên kết với nhau bởi các khớp: Hình 2.4: Cấu hình và các hệ trục tọa độ gắn trên Robot Scara Serpent. Robot Scara Serpent gồm 3 khớp chuyển động quay và một khớp chuyển động tịnh tiến. Gắn cho mỗi thanh nối một hệ trục toạ độ, ta có: - Khớp 1 quay quanh trục z0 góc θ1.
- Khớp 2 quay quanh trục z1 góc θ2. - Khớp 3 chuyển động tịnh tiến theo trục z2 đoạn d3. - Khớp 4 quay quanh trục z3 góc θ4. 2.2.1.2. Các thông số kỹ thuật của robot Scara Serpent Thông số của động cơ 1, 2, 3 tương ứng với các khớp 1, 2, 4 của tay máy robot Scara Serpent (xem bảng 2.1). - Động cơ 1 truyền động cho khớp 1 (main). - Động cơ 2 truyền động cho khớp 2 (fore). - Động cơ 3 truyền động cho khớp 4 - khớp cổ tay (wrist). Bảng 2.1: Thông số các động cơ của robot. T Loại U( I( M(N N(v/ P( J(Kg. R( L( m(K T V) A) m) p) W) m2) ) H) g) 1 J9Z 12 4,8 4.10-2 2100 15 0,32.1 1,3 100 0,6 F 04 8 2 J9Z 12 4,8 4.10-2 2100 15 0,32.1 1,3 100 0,6 F 04 8 3 J12 12 4,8 1,210 2100 26 1,5.10- 0,9 100 1 2 4 ZF 5 Bảng 2.2: Các thông số động học của robot Scara Serpent. TT Thông số Kích thước động học
1 m1 = 4 Khối lượng thanh nối 1. Kg 2 m2 = 1.5 Khối lượng thanh nối 2. Kg 3 m3 = 2 Khối lượng thanh nối 3. Kg 4 m4 = 0.6 Khối lượng thanh nối 4. Kg 5 a1 = 0.25 Chiều dài thanh nối giữa 2 khớp main và fore . m 6 a2 = 0.15 Chiều dài thanh nối giữa 2 khớp fore và cổ tay . m 7 Chiều dài thanh nối d3 phụ thuộc vào chế độ làm d3 việc của tay máy. 2.2.2. Giới hạn không gian làm việc của robot Scara Serpent Các biến khớp có các giới hạn góc quay như sau : 1 = -96 0  960 ( so với trục Ox ). 2 = -115 0  1150 (so với trục thanh 1). Chuyển động quay của khớp thứ nhất có hình chiếu bằng trong hệ trục toạ độ OX0Y0 và OX1Z1 (Hình 2.5) tương ứng với góc quay tổng trong thực tế là 1920. Chuyển động quay của khớp thứ hai có hình chiếu bằng trong hệ trục toạ độ OX1Y1 và OX2Y2 tương ứng với góc quay tổng là 2300. Từ đó ta có thể thấy được hình chiếu giới hạn không gian làm việc của nó (Hình 2.6).
Hình 2.5: Giới hạn góc quay của 2 khớp.
Hình 2.6: Giới hạn không gian làm việc của robot Scara Serpent. Như vậy khoảng không gian mà tay máy có thể với tới là toàn bộ hình trụ với đáy có đường giới hạn bên trong là một cung tròn có bán kính r = 0.231 (m) và đường giới hạn bên ngoài là đường tròn bán kính R = 0.4 (m). Khi biết được vị trí nào mà tay máy có thể đến được chúng ta có thể lập trình trong Matlab để tìm vị trí, quỹ đạo nào mà tay máy có thể vươn tới (được xét đến ở chương III trong bản luận văn này).