Thuyết minh đồ án robot công nghiệp Elbow

Trang 1

Lêi nãi ®Çu

Từ lâu, con người đã không còn xa lạ với từ “Robot” nữa Bởi lẽ, Robot đãxuất hiện nhiều trong cuộc sống của chúng ta và nếu chưa tận mắt chứng kiếnnhững Robot này hoạt động thì cũng được xem qua các phương tiện thông tin đạichúng

Có thể thấy Robot đã đi vào mọi lĩnh vực của đời sống con người Vậy,Robot được ứng dụng như thế nào? Có thể nói, Robot được ứng dụng rất phong phútrong đời sống con người, cả trong trường học và trong nông nghiệp Đạc biệt trongcông nghiệp, Robot được sử dụng rộng rãi để làm một số công việc: vận chuyểnnguyên vật liệu, sản phẩm, máy móc hay làm những công việc nặng nhọc, hoặctrong những môi trường làm việc có nhiệt độ cao, độc hại…

Đầu tiên, Robot được dùng trong một số ngành công nghiệp kỹ thuật cao nhưcông nghiệp xe hơi, công nghiệp máy bay…để làm những công việc như hàn thân

xe, phun sơn…Những Robot này là những cánh tay máy mô phỏng con người, mỗitay máy bao gồm nhiều khâu liên kết với nhau bằng các khớp Các khâu này có thểchuyển động tương đối với nhau và làm thay đổi tầm với của Robot Thông thườngnhững Robot này được đặt cố định một chỗ và chỉ thao tác được trong khả năng tầmvới của chúng

Với những kiến thức đã học và sau một thời gian tìm hiểu cùng với sự giúp

đỡ tận tình của thầy giáo, sự đóng góp trao đổi xây dựng của bạn bè nhóm em đãhoàn thành nhiệm vụ được giao

Song với những hiểu biết còn hạn chế nên nhóm em không tránh khỏi nhữngthiếu sót Chúng em rất mong được sự chỉ bảo của thầy giáo để bài tập của nhóm

em hoàn thiện hơn

Nhóm em xin chân thành cảm ơn các thầy trong bộ môn đã tận tình giúp đỡnhóm em đặc biệt là thầy giáo hướng dẫn ThS Nguyễn Trọng Du

CHƯƠNG I:

Trang 2

GIỚI THIỆU CÁC GÓC QUAY CƠ BẢN VÀ BỘ THÔNG SỐ ĐỘNG

HỌC DH1.1 Phép quay (Rotation) quanh các trục tọa độ

Giả sử ta cần quay một điểm hoặc một vật thể xung quanh trục tọa độ nào đó vớigóc quay θ0, ta lần lượt có các ma trận chuyển đổi như sau:

- Quay một góc φ xung quanh trục z

- Quay tiếp một góc θ xung quanh trục y mới, đó là y’

- Cuối cùng quay một góc ψ quanh trục z mới, đó là z’’

Trang 3

Hình 1.1 : Phép quay Euler

Ta biểu diễn phép quay Euler bằng cách nhân ba ma trận với nhau :

Euler (φ,θ,ψ ) = Rot(z, φ )Rot(y, θ )Rot(z, ψ )

Kết quả của phép quay phụ thuộc chặt chẽ vào thứ tự quay, tuy nhiên ở phép quayEuler nếu thực hiện theo thứ tự ngược lại, nghĩa là quay góc ψ quanh z rồi tiếp đếnquay góc θ quanh y và cuối cùng quay góc φ quanh z cũng đưa đến kết quả tương

tự (Xét trong cùng hệ quy chiếu)

( , , ) ( , ) ( , ) ( , )

Rφ θ ψ =R z φ R yθ R zψVới :

Trang 4

Hình 1.2 : Các thông số của khâu θ , d, a, α

Các thông số cơ bản giữa hai trục quay của khớp động i và i+1 :

ai là độ dài đường vuông góc chung giữa hai trục khớp động i và i+1, khi các trục z

không cắt nhau thì a bằng khoảng cách pháp tuyến của hai trục, khi các trục z cắtnhau thì a=0

Trang 5

α là góc chéo giữa hai trục khớp động i và i+1, iα = góc quay quanh trục xi biến

zi thành 1 zi+

di là khoảng cách đo dọc trục khớp động i từ đường vuông góc chung giữa trục

khớp động i và trục khớp động i+1 tới đường vuông góc chung giữa khớp động i vàtrục khớp động i-1

i

θ là góc giữa hai đường vuông góc chung nói trên.

Bộ thông số này được gọi là bộ thông số Denavit – Hartenberg hoặc viết tắt là bộthông số DH

Biến khớp:

Nếu khớp động i là khớp quay thì iθ là biến khớp, iθ = *θi

Nếu khớp động i là tịnh tiến thì di là biến khớp.

Để kí hiệu biến khớp dùng thêm dấu * và trong trường hợp khớp tịnh tiến thì ai

được xem là bằng 0

CHƯƠNG II:

HỆ PHƯƠNG TRÌNH ĐỘNG HỌC CỦA ROBOT ELBOW

2.1 Các hệ tọa độ

Gán các hệ tọa độ với các khâu như trên hình 2.1 :

(Các hệ tọa độ trên các khâu của robot tuân theo quy tắc bàn tay phải)

- a1=0 do trục Z0 và Z1 vuông góc với nhau.

Trang 6

- α1=900 là góc quay quanh trục 1x để biến 0 z thành 1z

- α2=0 là góc quay quanh trục 2x để biến 1z thành 2 z

- α3=0 là góc quay quanh trục 3x để biến 2 z thành 3 z

- α4= −900 là góc quay quanh trục 4x để biến 3 z thành 4 z

- α5=900 là góc quay quanh trục 5x để biến 4 z thành 5 z

- α6 =0 là góc quay quanh trục 6x để biến 5 z thành 6 z

- 1d là khoảng cách đo dọc trục giữa O0 và O1

- 6d là khoảng cách đo dọc trục giữa O5 và O6

Hình 2.1 : Vị trí ban đầu của robot Elbow và các hệ tọa độ

Trang 9

Để tính 6T , ta phải nhân 1 A với 1 T6

sau đó cân bằng các phần tử của ma trận 6T tađược một hệ thống các phương trình sau:

Trang 10

Hình 3.2 Bảng thông số DH của robot Elbow

Trong ví dụ mô phỏng robot này chúng ta chọn các giá trị như sau:

Trang 11

Bật nút lệnh số 5 trên menu ngang, dưới.

Vào menu chính : FILE -> LOAD -> ROBOTFILE chọn DHTempl ->OPEN.Vào menu chính : ROBOTICS -> ROBOTMOTION + KINEMATICS ->

KINEMATICS DATAChọn Active Join -> Ok -> Activ Joint (1) RZ (khớp thứnhất là khớp quay) -> Ok -> Nhập các thông số DH của khâu thứ nhất

Vào lại bước 4 -> Number Active Joint(1) -> Ok -> ấn đúp chuột vào vệt xanhhoặc đưa con trỏ vào phần nhập dữ liệu (text box) ấn 2 (Bây giờ số khớp động là 2),nhập các thông số DH cho khâu số 2

Trang 12

Làm tương tự nhập các thông số DH cho 4 khâu còn lại Chú ý tất cả cáckhớp đều là khớp quay (Activ Joint (n) RZ)

Kết quả các độ gắn trên các khâu như hình sau

Trang 14

• Chọn vị trí đặt của khâu

• Điều chỉnh kích thước của khâu

• Chọn khớp mà khâu nối vào

Trang 15

• Đặt tên cho khâu

Sau khi ấn OK ta được khâu 1 như hình vẽ

Nếu chưa vừa ý chúng ta có thể sửa chửa kích thước khâu, thay đổi vị trí củakhâu, thay đổi màu hoặc có thể xóa đi

Làm tương tự với các số liệu như sau để thiết kế hình dáng các khâu còn lại

Trang 17

- Cách 1: Load một dụng cụ làm việc có sẵn trong thư viện.

Trang 18

Ta nhập các kích thước như sau:

R=0,025; Z=0,01;

Ta được modul thứ nhất :

Các thông số khác giữ nguyên

Ta làm tương tự để ra hình dáng như hình vẽ với các thông số như sau:

X top:0,054 Y top: 0,010,03 dy: 0,0010,005

Trang 19

3.4 Thiết kế đối tượng làm việc

• Vào menu 3D-CAD -> select group -> body group-> ok (Để thiết kế đốitượng làm việc làm việc)

• Ta bắt đầu tạo bàn làm việc lần lượt các bước theo hình vẽ sau:

Trang 21

• Sau đó vào phần 3D-CAD => color => yellow để chọn màu cho vật Ta tạo lần lượt để có sản phẩm cuối cùng như hình vẽ.

• Lưu ý: sau mỗi lần chỉnh sửa hay tạo mới chúng ta nên save lại như hình vẽ:

Kết quả sau khi thiết kế xong robot:

Trang 23

Để lập trình điều khiển robot đã mô phỏng ta dùng phương pháp lập trình kiểudạy học Sau khi đã thiết kế hình dáng robot, công cụ gắn trên khâu chấp hành cuối,các đối tượng làm việc khác ta có thể lập trình để điều khiển robot đã mô phỏng.Việc lập trình thực hiện theo trình tự sau:

Nhấn chuột vào (Show program window) để kích hoạt cửa sổ lập trình

Chọn New để đặt tên cho file chương trình

Chọn Append nếu muốn bổ xung một chương trình đã có

Xác định vị trí các điểm mà dụng cụ phải đi qua (dùng chuột để điều khiển cáckhớp) Sau mỗi lần xác định được một vị trí thì ấn nút PTP (điều khiển điểm) hoặcLIN (điều khiển đường) hoặc VIA (điểm trung gian dẫn hướng khi điều khiểnđường cong), CIRC (điều khiển theo đường cong) Làm liên tục cho tất cả các điểm

để có một chương trình hoàn thiện

Sau khi kết thúc việc dạy robot học, ấn nút Close trên Program Window để kết thúc

Để hiệu chỉnh và bổ xung các lệnh điều khiển khác vào chương trình, ấn chuột vàonút Edit, dùng các lệnh của EasyRob như dưới đây để hoàn thiện chương trình

Các lệnh dùng trong lập trình:

PROGRAMFILE: Bắt đầu chương trình

ENDPROGRAMFILE hoặc END: Kết thúc chương trình

PTP X Y Z A B C : Di chuyển robot đến điểm mới

WAIT x [sec]: Robot dừng hoạt động trong x giây

ERC LOAD TOOL filename: Gọi một tool file

ERC LOAD VIEW filename: Gọi một view file

ERC GRAB BODY bodyname: Dụng cụ cầm lấy một vật thể có tên bodynameERC RELEASE BODY bodyname: Dụng cụ thả một vật thể có tên bodynameERC ROBOT BASE X Y Z A B C: Di chuyển gốc tọa đọ cơ bản của robot đến vịtrí mới

Trang 24

Chương trình:

PROGRAMFILE

! prgfln E:\phan mem hoc tap\robot\EASY_ROB\proj\phanmem.prg

erc load tool kepto

erc load view 1

PTP_AX -19.5000 57.5000 -69.0000 -83.4999 89.0000 0.0000

PTP_AX -14.0000 47.0000 -96.9999 -37.4999 89.0000 -105.0000erc load tool kepnho

erc grab body t25

wait 1

PTP_AX -14.5000 61.0000 -96.9999 -37.4999 89.0000 -105.0000PTP_AX -88.5000 61.0000 -96.9999 -37.4999 89.0000 -105.0000erc robot_base 0 -1 0 0 0 0

PTP_AX -129.4999 29.0000 -26.4999 -79.9999 89.0000 -46.0000PTP_AX -132.4999 9.0000 -13.2222 -83.9999 89.0000 -43.5000

erc load tool kepto

erc release body t25

PTP_AX -132.4999 10.5000 -1.2222 -83.9999 89.0000 -43.5000

PTP_AX 5.5001 38.5000 -48.7222 -83.9999 89.0000 -43.5000

PTP_AX 4.0001 35.5000 -70.2221 -50.9999 89.5000 3.0000

erc load tool kepnho

erc grab body tn28

PTP_AX -164.3002 31.9888 -62.7222 -54.7999 90.5000 14.5000erc load tool kepto

erc release body tn28

wait 1

PTP_AX -164.3002 55.9888 -62.7222 -54.7999 94.5000 14.5000PTP_AX 54.1998 55.9888 -62.7222 -54.7999 94.5000 14.5000

PTP_AX 57.1998 17.9888 -33.2222 -70.2999 87.5001 -32.0000

erc grab body td8

wait 1

PTP_AX 57.1998 32.9888 -33.2222 -70.2999 87.5001 -32.0000

PTP_AX 194.1997 39.4888 -80.7223 -44.7999 88.7000 -75.0001erc load tool kepto

erc release body td8

wait 1

PTP_AX 194.1997 63.4888 -80.7223 -44.7999 88.5000 -75.0001PTP_AX 30.6998 28.9888 -41.2223 -69.7999 88.5000 -75.0001

PTP_AX 32.6998 23.4888 -44.7223 -64.7998 87.5000 -146.0000erc load tool kepnho

Trang 25

erc grab body tn27

wait 1

PTP_AX 30.6998 28.9888 -41.2223 -69.7999 88.5000 -75.0001

PTP_AX 194.1997 63.4888 -80.7223 -44.7999 88.5000 -75.0001PTP_AX 198.6997 39.9888 -80.7223 -51.2999 92.0000 20.4999erc load view 3

erc load tool kepto

wait 1

PTP_AX 198.6997 57.4888 -76.2223 -38.2999 94.0000 18.4999PTP_AX 49.1997 1.9888 0.7777 -79.2998 88.5000 -31.5001

erc grab body tbx16

wait 1

PTP_AX 49.1997 23.9888 -29.7223 -54.7998 86.0000 -31.5001

PTP_AX 195.1111 32.2222 -64.7223 -53.2999 80.0000 63.0000

erc load tool kepto

erc release body tbx16

wait 1

PTP_AX 198.1997 58.4888 -64.7223 -53.2999 97.0000 70.9999PTP_AX 51.6997 1.4888 3.7777 -87.7999 87.5000 52.4999

erc grab body tbx8

wait 1

PTP_AX 47.1996 38.4888 -33.7223 -87.7999 87.5000 52.4999

PTP_AX 192.6996 61.4888 -94.2222 -49.2999 88.0000 65.9999PTP_AX 195.8596 45.6888 -92.9223 -38.0000 88.5000 74.0000erc load tool kepto

erc release body tbx8

PTP_AX 200.2001 56.9888 -83.7223 -48.7999 89.0000 65.5000PTP_AX 90.7000 43.4888 -59.2223 -48.7999 89.0000 100.5000erc robot_base 0 -1 0 0 0 0

PTP_AX 51.7000 3.4888 -0.7223 -92.7999 87.5000 140.4999

erc grab body t24

wait 1

PTP_AX 51.7000 27.4888 -0.7223 -92.7999 87.5000 140.4999

PTP_AX 219.6999 49.4888 -70.2223 -56.7999 87.5000 121.9999PTP_AX 222.6999 32.9888 -65.2223 -52.7999 92.5000 130.9997erc load view 4

erc load tool kepto

wait 1

PTP_AX 222.6999 50.9888 -65.2223 -52.7999 92.5000 130.9997PTP_AX 364.6995 40.4888 -81.2223 -48.5999 90.0000 185.9997erc load tool kepnho

erc grab body tn26

Trang 26

wait 1

PTP_AX 219.8997 54.2888 -63.9224 -53.0998 85.5000 218.9995PTP_AX 84.8996 54.2888 -63.9224 -53.0998 85.5000 218.9995erc robot_base 0 -0.8 0 0 0 0

PTP_AX 43.8997 26.7888 -51.4224 -62.5998 91.5000 135.9996erc load tool kepnho

erc grab body t23

wait 1

PTP_AX 225.8997 20.2888 -25.9224 -80.0997 84.5000 137.4996PTP_AX 57.8997 20.2888 -25.9224 -80.0997 84.5000 137.4996PTP_AX 45.8997 15.2888 -25.9224 -80.5997 88.0000 134.4996

erc grab body t22

wait 1

erc grab body t21

wait 1

PTP_AX 217.3996 63.2888 -76.9224 -42.0998 90.5000 115.4994PTP_AX -10.1004 44.2888 -90.4223 -40.5998 90.5000 169.9994erc load tool kepnho

erc grab body tn25

wait 1

PTP_AX -8.6004 56.7888 -89.9223 -40.5998 90.5000 169.9994

Trang 27

PTP_AX 218.8996 31.3000 -61.9224 -54.0998 90.5000 216.4992erc load tool kepto

wait 1

PTP_AX 218.3996 51.0000 -61.9224 -54.0998 92.5000 216.4992PTP_AX 91.3996 51.0000 -61.9224 -54.0998 92.5000 216.4992PTP_AX 49.3996 4.0000 -1.9224 -89.5998 91.0001 139.9992

erc grab body t20

PTP_AX 49.8996 16.5000 -13.4224 -89.5998 91.0001 139.9992

PTP_AX 212.8994 37.0000 -73.6225 -52.5998 89.0001 123.4993erc load tool kepto

wait 1

PTP_AX 212.8994 58.2000 -73.4225 -52.5998 89.0001 123.9993PTP_AX 89.3995 58.2000 -73.4225 -52.5998 89.0001 123.9993erc robot_base 0 -0.5 0 0 0 0

erc grab body t19

wait 1

PTP_AX 223.8994 37.2000 -36.4225 -74.0998 90.5001 124.4990PTP_AX 40.8994 28.7000 -54.9225 -64.0999 90.5001 130.4988erc load tool kepnho

erc grab body t18

wait 1

PTP_AX 220.8993 36.7000 -59.4225 -62.0999 88.0001 129.9988PTP_AX 87.8994 36.7000 -59.4225 -62.0999 88.0001 129.9988

erc robot_base 0 -0.5 0 0 0 0

erc grab body t17

wait 1

PTP_AX 214.3994 33.5000 -66.9225 -55.5998 90.0001 121.9987

Định dạng
Số trang	47
Dung lượng	1,21 MB