Giao diện được thiết kế như hình 3.5:
Hình 3.5. Giao diện bài toán động học thuận
Trong giao diện có “Bảng D-H” gồm các Edit Text có “tag” là di qi ai api với i là các số tương ứng với khâu. Các bảng 1H0, 2H1, 3H2, 4H3, 5H4, 6H5 được xuất các ma trận truyền có “tag” từ text1 đến text112(Code phụ lục 1.1)
3.1.3. Giải bài toán động học ngƣợc
Giao diện được thiết kế như hình 3.6:
Thực hiện nhập độ dài các khâu, tọa độ vị trí công tác và nhấn nút thực hiện. Kết quả được thể hiện trong bảng “Góc”. Hàm chính được viết trong hàm callback (phụ lục 1.2)
3.1.4. Thiết kế quỹ đạo
Giao diện được thiết kế như hình 3.7:
Hình 3.7. Giao diện quỹ đạo chuyển động
Giao diện có thể nhập các thông số của robot, vị trí điểm đầu cuối cần di chuyển.Nút “Thực hiện” có chức năng lấy các thông số đã nhập, thực hiện tính các quy luật khớp, và vẽ quỹ đạo chuyển động.Code được viết trong hàm Callback (phụ lục 1.3)
3.1.5. Tính momen động cơ
Lấy kết quả của phần mềm thiết kế quỹ đạo làm đầu vào để tính momen động cơ như hình 3.8
Thêm lệnh momendc (handles.data); trong nút nhấn “Thực hiện” và viết chương trình bên giao diện thứ 2 để tính momen của ba động cơ (phụ lục 1.4)
3.1.6. Thiết kế điều khiển
a) Tạo giao diện điều khiển như hình 3.9
Hình 3.9. Giao diện điều khiển chính
Trong giao diện điều khiển chính như hình 3.10 có: - Bảng điều khiển:
Hình 3.10. Bảng điều khiển
Bảng điều khiển thực hiện kết nối và ngắt kết nối với máy tính, cài đặt vị trí ban đầu cho cánh tay, thực hiện di chuyển cánh tay từ vị trí hiện tại tới vị trí được khai báo trong bảng “Theo góc” hoặc “Tọa độ”.
- Bảng “Teaching Mode”
Hình 3.11. Bảng Teaching Mode
Bảng „Teaching Mode” thực hiện lưu lại vị trí trong ma trận, trạng thái cánh tay gắp nhả, tạo chương trình di chuyển cho cánh tay. Có thể di chuyển với lượng tiến góc của cánh tay trong bảng này.
Hình 3.12. Thông báo chương trình chạy của robot
Thông báo vị trí hiện tay của cánh tay di chuyển tưới, vị trí được lưu trước trong bảng “Teaching Mode”, trạng thái của tay kẹp trong từng vị trí.
Code chương trình được viết trong các lựa chọn : “kết nối”, “ngắt”, “set ban đầu”, “tăng góc”, “giảm góc”, “lưu vị trí”, “xóa vị trí”, “thực hiện” (phụ lục 1.5)
3.2. Thiết kế hệ thống cơ khí 3.2.1. Tính chọn động cơ 3.2.1. Tính chọn động cơ
Do tính toán momen sơ bộ theo matlab như hình 3.8 thì momen trên động cơ 2 là lớn nhất nên ta chọn động cơ 2, hai động cơ còn lại chọn giống động cơ hai.
Giả sử bán kính trục thiết kế có Rtr= 5 mm, trục chịu tác dụng của lực ma sát tại ổ lăn, lực ma sát có giá trị: Fms=0.05*P*d/Rtr [6]
Trong đó:
- k =0.01†0.05: hệ số ma sát của ổ lăn - Rtr=0.005: bán kính trục (m)
- d=l2=0.23(m)
- P=m2*g= 1.5949*9.8=15.63(N)
Thay vào công thức: Fms=0.05*P*d/Rtr = 0.05*15.63*0.23 /0.05= 3.6 (N) Để cánh tay Robot hoạt động được thì momen tác động lên trục phải thắng được momen của lực ma sát ổ lăn tác động lên trục: M >Fms= 3.6 (N)
Do Robot chủ yếu phục vụ công tác đào tạo nên chọn tốc độ quay của trục là 30 (v/ phút), hơn nữa Robot sử dụng bộ truyền đai răng có tỷ số truyền bằng 2 nên chọn số vòng quay n= 2*30 = 60 (v/ phút)
Vậy công suất động cơ: Ptr>
=
= 22.6(W)
Chọn động cơ: PITTMAN DC GEAR MOTOR 24 VDC 65.5:1 RATIO MODEL GM9434H926.
Thông số kỹ thuật của đông cơ: Công suất P = 27.57 (W), điện áp 24V, đĩa encoder 100 xung/ vòng. Tốc độ quay 80v/ phút
3.2.2. Tính trục
Trục 1 (trục tại khớp 3)
Xác định momen lớn nhất tác dụng lên trục:
Giả sử cánh tay nâng vật nặng 100(g), khâu thứ 3 nặng 216,05(g) được thay thế bằng lực tương đương tại trọng tâm như hình 3.13
Tổng momen tác dụng lên trục và biểu đồ momen (hình 3.14): → M = 0.21605 75 + 0.1 150 = 305.8 (Nmm)
Gọi: +) M1 là momen cánh tay tác dụng lên trục: M1 = M/2 = 152.9 (Nmm) +) M2 là momen động cơ cần thiết tác dụng lên trục M2 = M1
Hai vị trí đặt của M1 và M2 là vị trí của cánh tay và động cơ (hình 3.14) Trục chịu lực cắt lớn nhất khi cánh tay ở vị trí cao nhất, khi đó lực cắt: P = (0.21605 + 0.1) 9.8 = 3 (N)
Gọi: +) N3, N4 là hai lực cắt cánh tay tác dụng: N3 = N4 = P/2 =1,5 (N) Khi đó
+) N1, N2 là hai phản lực: N1 = 1,8 (N), N2 =1,2 (N) Biều đồ momen:
Hình 3.14. Biểu đồ momen trục 1
Tại điểm đặt lực N4 là điểm nguy hiểm, ta có momen tương đương tại điểm này: Mtd = √ = 26.4 (Nmm)
Chọn vật liệu cho trục: thép C45 có trị số ứng suất cho phép [σ] = 80 MPa
Đường kính cần thiết:d = √ ] = √
Trục 2 (trục tai khớp 2)
Khối lượng khâu 2 và 3: m= 1594.9 + 216.05 = 1811 (g), cánh tay nâng vật nặng 100 (g) như hình 3.15. Trục 2 chịu tác dụng của momen xoắn do khối lượng của khâu 2, khâu 3 và vật nâng gây ra:
Hình 3.15. Trục tại khớp 2
Tổng các momen tác dụng lên trục:
M = M2 126.5 + M3 328 + M0 403 = 3066.44 (Nmm) Trong đó: M1, M2 là momen xoắn do cánh tay và động cơ tác dụng lên truc 2 M1 = M2 = = 1533,22 (Nmm)
Trọng lượng của khâu 2,3:P = M0 + M2 + M3 = 19 (N)
Gọi N3, N4 là lực cắt của cánh tay tác dụng lên trục: N3 = N4 = = 9,5 (N), khi đó có
hai phản lực ta có hai phản lực N1 = 11, N2 = 8 (N) Biểu đồ momen:
Ta thấy điểm đặt lực N4 là điểm nguy hiểm, momen tương đương tại điểm này: Mtd = √ = 122.6 (Nmm)
Chọn vật liệu cho trục: thép C45 có trị số ứng suất cho phép [σ] = 80 MPa
Đường kính trục cần thiết:d = √ ] = √
= 2.5 (mm)
Trục 3 (trục tại khớp 1)
Trục chịu tác dụng chủ yếu bởi momen uốn và momen xoắn như hình 3.17
Hình 3.17. Trục tại khớp 1
Momen uốn lớn nhất được tạo ra bởi cánh tay tại vị trí xa nhất.
M = M2 126.5 + M3 328 + M0 403 = 3066.44 (Nmm)
Momen xoắn lớn nhất được tạo ra khi cho cánh tay quay với gia tốc lớn nhất, giả sử gia tốc lớn nhất là 1 m/s2. Khi đó momen lớn nhất được tính như sau:
Mz = M2 a 126.5 + M3 a 328 + M1 a 403 = 313 (Nmm) Biểu đồ momen:
Dựa vào biểu đồ nội lực ta thấy điểm đặt momen Mz2 là điểm nguy hiểm, ta có momen tương đương tại điểm này:
Mtd = √ = 225.1 (Nmm) Chọn vật liệu: thép C45 => [σ] = 80
Đường kính cần thiết:d = √ ] = √
= 3.1 (mm)
3.2.3. Thiết kế khung cho robot cầu RRR
Khung đế phải được thiết kế gọn nhẹ,đủ độ cứng,đứng vững chịu được tải trọng của toàn bộ robot. Phần đế được làm bằng thép d=3mm, đủ nặng để giữ robot không bị lật về phía trước. Các phần khung robot được làm bằng nhôm tấm dày 3mm.
Hình 3.19. Khung robot
3.2.4. Tính cánh tay robot
a) Cánh tay 1:
Cánh tay gồm 2 tấm có trọng lượng nhẹ,thẩm mĩ, đơn giản dễ gia công và tháo lắp.Vật liệu nhôm A1050. Bề dày d=2mm
Hình 3.20. Cánh tay 1
b) Cánh tay 2:
Cũng giống như modul cánh tay 1,bao gồm 2 tấm nhôm nhẹ ,dễ gia công và tháo lắp.Vật liệu nhôm A1050. Bề dày d= 2mm
Hình 3.21. Cánh tay 2
c) Thiết kế tay kẹp
Tay kẹp có khả năng gắp được vật có hình dạng khác nhau:hình lập phương,hình chữ nhật…Thiết kế điều khiển bằng xilanh-khí nén.Kích thước kẹp có bề rộng: 30-40mm
Hình 3.22. Tay kẹp
3.2.5. Tính chọn ổ bi
Robot được lắp 3 ổ bi giống nhau tương ứng tại 3 khớp để tạo chuyển động cho 3 trục. Do 3 trục chọn đều có đường kính d = 10 mm nên ta chọn ổ bi LYC 6200 RS
Ổ bi loại 6200RS: Ổ bi cầu, chịu tải mức trung bình. Đường kính trong: d= 10mm, chiều cao: h= 8mm, đường kính ngoài: D= 30mm. Tốc độ tải tối đa: Vmax= 1800RMP. Số lượng bi: 10 viên
3.2.6. Tính chọn bộ truyền động đai răng robot RRR
Chọn đai răng theo tiêu chuẩn ISO như bảng 3.1
Bảng 3.1. Các ký hiệu L, H, XL và bước đai tương ứng
Nhìn bảng trên ta thấy việc chọn đai phụ thuộc vào: bước răng, độ rộng đai, số lượng răng của bánh đai, độ dày của pulley.
Đai truyền được chọn theo công suất và tốc độ quay của động cơ qua công suất như hình 3.2:
Hình 3.23. Hình lựa chọn bộ truyền đai
Động cơ DC servo điều khiển với tốc độ: n= 60 vòng/phút; Công suất động cơ: Pđc= 27 W
Dựa vào bảng ta chọn loại L
Thiết kế bánh đai theo tiêu chuẩn với phần mềm hỗ trợ GEARTRAX như hình 3.24.
Tiến hành chọn:Bước răng: Belt Pitch=3mm; Độ rộng đai: Belt Width=0.313in belt width (= 9mm); Số lượng răng của bánh đai: Number of Teeth=16; Chọn tấm chắn cho bánh đai: Flange Creation; Chọn độ rộng của pulley: 12m
Sau khi hoàn tất, ấn Create để xác nhận:
Phần mềm Solidwork 2010 tự động chạy quá trình tính toán và vẽ ra biên dạng pulley, sau đó ta chỉnh sửa để được sản phẩm hoàn thiện (hình 3.24)
Hình 3.25. Mô hình pulley nhỏ trong SolidWork
Ta làm tương tự với bánh đai lớn:
Hình 3.26. Thông số pulley lớn
Bánh đai đã được thiết kế xong:
Tiếp theo tiến hành chọn dây đai: Chọn dây đai theo tiêu chuẩn băng phần mềm trực tuyến từ trang web: http://www.hpcgears.com/calc.htm
Bộ truyền động thiết kế có thông số cơ bản là:
Số răng bánh đainhỏ =25; Số răng bánh đai lớn =50: Khoảng cách 2 trục: d=200mm: Bước răng: Pitch=3mm
Hình 3.28. Chọn loại đai
Theo hình 3.28trên chọn được dây đai HTD531
3.2.7. Chế tạo hệ thống cơ khí
Sau khi thiết kế robot ta tiến hành gia công, chế tạo các chi tiết của hệ thống cơ khí. Một chi tiết điển hình cùng vật liệu chế tạo và phương pháp gia công được trình bày trong bảng 3.2:
STT Tên chi
tiết Chi tiết Vật liệu phôi
Phương án gia công 1 Đế Thép Máy cắt tay 2 Thân dưới Thép Máy cắt tay Hàn Khoan lỗ
3 Gá động cơ số 1 Thép -Dập tạo hình dạng -cắt dây tạo rãnh -Khoan lỗ và taro 4 Thanh tay 2 Nhôm tấm D = 3mm -Cắt dây -Khoan lỗ 5 Trục số 1 Thép Ø10 Tiện Khoan lỗ và taro 6 Trục số 2 Thép Ø10 Tiện 7 Trục số 3 Thép Ø10 Tiện 8 Đệm thân số 1 Nhôm tấm D = 3mm Máy dập Khoan 9 Thân số 1 Nhôm tấm D = 3mm Cắt dây Máy dập Khoan lỗ 10 Hệ thống căng đai 2 Nhôm Phay Khoan lỗ
11 Ca bi 1 Nhựa cứng Tiện Khoan lỗ 12 Tay số 2 Nhôm tấm d = 2 mm Cắt dây Máy cắt tay Khoan 13 Ca bi 3 Nhôm tấm d=2mm Máy cắt tay Khoan lỗ 14 Tấm gá tay kẹp Nhôm tấm D = 2mm Máy dập Khoan lỗ 15 Pulley nhỏ Nhôm Máy tiện Cắt dây Khoan và taro 16 Pulley số 2 Nhôm Máy tiện Cắt dây Khoan và taro 17 Pulley số 3 Nhôm Máy tiện Cắt dây Khoan lỗ 18 Pulley số 4 Nhôm Máy tiện Cắt dây Khoan lỗ và taro
19 Pulley Số 5 Nhôm Tiện Cắt dây Khoan lỗ và taro 20 Pulley Số 6 Nhôm Tiện Cắt dây Khoan lỗ 21 Con lăn
căng đai Nhôm Tiện
22 Trục căng đai Thanh nhôm có ren mua 23 Tấm gá động cơ số 1 Nhựa cứng Máy phay Khoan lỗ và taro 24 Tấm gá động cơ số 2 Nhựa cứng Máy phay Khoan lỗ và taro 25 Miếng ốp thân 1 Nhôm tấm d = 1,5mm Dập và khoan 26 Miếng ốp thân 1.1 Nhôm tấm d = 1,5mm Dập và khoan lỗ
27 Miếng ốp thân 2.1 Nhôm tấm D = 1,5mm Dập và khoan lỗ 28 Miếng ốp thân 2.1 Nhôm tấm D = 1,5mm Dập và khoan lỗ 29 Miếng ốp thân 3.1 Nhôm tấm S = 1,5mm Dập và khoan lỗ 30 Miếng ốp thân 3.2 Nhôm tấm D = 1,5mm Dập và khoan tạo lỗ
Bảng 3.2. Các chi tiết điển hình trên robot
3.3. Thiết kế, thi công mạch điều khiển
Dựa vào kết cấu Robot cần chế tạo ta thấy nguồn động lực của robot là 3 động cơ Servo, việc điều khiển 3 động cơ này rất quan trọng vì nó quyết định chuyển động của robot.
3.3.1. Nguyên lý điều khiển động cơ
Động cơ DC servo hoạt động dựa trên các lệnh điều khiển vị trí và tốc độ.Động cơ DC servo khác động cơ DC thường ở khả năng đáp ứng, tốc độ đáp ứng, vùng điều khiển, khả năng ổn định tốc độ và khả năng chịu đụng của động cơ. Về cơ bản thì một động cơ DC servo và một động cơ DC thường giống nhau về cấu tạo và nguyên lý hoạt động (cũng có phần cảm, phần ứng, cách đấu dây...). Vậy nên nguyên lý điều khiển động cơ DC servo và động cơ DC thường giống nhau [9].
a) Mạch nguyên lý
Hình 3.29. Động cơ
Khí nhấn nút động cơ hoạt động, khi thả nút, động cơ dừng hoạt động. Do tốc độ nhấn thả có hạn nên động cơ bị “sượng”. Giải pháp được đưa ra là sử dụng công tắc điện tử (driver), thực hiện nhấn thả với tần số lớn. Giả sử nhấn 5000 lần/s, tổng thời gian cho một lần nhấn thả là: 1/5000 (s) = 200 (us). Có sự khác biệt giữa trường hợp nhấn 150us thả 50us và trường hợp nhấn 50us và thả 150us, trong trường hợp 1 tốc độ động cơ sẽ nhanh hơn trường hợp 2. Do đó có thể sự dụng xung PMW (xung có thể điều chỉnh độ rộng) để điều khiển tốc độ động cơ.
Hình 3.30. Nguyên lý điều khiển
Từ ví dụ trên ta có thể xây dựng mạch nguyên lý như sau: Sử dụng chíp Atmega điều khiển xung PMW.
Hình 3.31. Mạch nguyên lý b) Chip driver L298D (mạch công suất)
Hình 3.32. Mạch công suất
L298D là một chip tích hợp 2 mạch cầu H trong gói 15 chân.Tất cả các mạch kích, mạch cầu đều được tích hợp sẵn. L298D có điện áp danh nghĩa cao (lớn nhất 50V) và dòng điện danh nghĩa lớn hơn 2A nên rất thích hợp cho các các ứng dụng công suất nhỏ như các động cơ DC loại nhỏ và vừa. Chíp L298D có thể làm driver cho motor.
Hình 3.33. Chip L298
Hình 3.32 là hình dáng bên ngoài và tên gọi các chân của L298D. Hình phía dưới là cấu trúc bên trong chip. Có 2 mạch cầu H trên mỗi chip L298D nên có thể điều khiển 2 đối tượng chỉ với 1 chip này. Mỗi mạch cầu bao gồm 1 đường nguồn Vs (thật ra là đường chung cho 2 mạch cầu) cấp nguồn cho động cơ, một đường current sensing (cảm biến dòng), phần cuối của mạch cầu H không được nối với GND mà bỏ trống cho người dùng nối một điện trở nhỏ gọi là sensing resistor. Bằng cách đo điện áp rơi trên điện trở này chúng ta có thể tính được dòng qua điện trở, cũng là dòng qua động cơ. Mục đích chính của việc đo dòng điện qua động cơ
là để xác định các trường hợp nguy hiểm xảy ra trong mạch, ví dụ quá tải. Nếu việc đo dòng động cơ không thật sự cần thiết bạn có thể nối đường current sensing này với GND. Động cơ sẽ được nối với 2 đường OUT1, OUT2 (hoặc OUT3, OUT4 nếu dùng mạch cầu bên phải). Một chân En (EnA và EnB cho 2 mạch cầu) cho phép mạch cầu hoạt động, khi chân En được kéo lên mức cao, mạch cầu sẵn sang hoạt động. Các đường kích mỗi bên của mạch cầu được kết hợp với nhau và nhưng mức điện áp ngược nhau do một cổng Logic NOT. Bằng cách này chúng ta có thể tránh được trường hợp 2 transistor ở cùng một bên được kích cùng lúc (ngắn mạch).Như vậy, sẽ có 2 đường kích cho mỗi cầu H gọi là In1 và In2 (hoặc In3, In4). Để motor hoạt động chúng ta phải kéo 1 trong 2 đường kích này lên cao trong khi đường kia giữ ở mức thấp, ví dụ In1=1, In2=0. Khi đảo mức kích của 2 đường In, động cơ sẽ đảo chiều quay. Tuy nhiên, do L298D không chỉ được dùng đề đảo chiều động cơ mà còn điều khiển vận tốc động cơ bằng PWM, các đường In cần được “tổ hợp lại”