Để có thể lắp vật chính xác vào vị trí cần lắp ráp khi bảng làm việc di chuyển trên băng tải đòi hỏi hệ thống phải có cảm biến xác định vị trí của bảng làm việc so với vị trí cần gắp. Từ yêu cầu đó, ta sử dụng cảm biến tiệm cận để thực hiện công việc này. Khoảng cách đặt cảm biến là cố định, vận tốc băng tải cố định được điều khiển bởi Driver DCS3T-25 do đó thời gian di chuyển của bảng làm việc đến vị trí lắp ráp là xác định được.
S Đ S Đ S S Đ S Đ
Hình 4.4: Lưu đồ giải thuật điều khiển trên Transmit khi tiến hành lắp vật
Start Nhận dữ liệu
từ máy tính
End
Return Khai báo cấu hình hoạt động
cho các chức năng : Can, Uart
Khai các biến sự kiện ngắt
Kích hoạt ngắt
Truyền tín hiệu lên máy tính
Nhận dữ liệu từ máy tính
Gởi dữ liệu nhận được cho 6 mạch Receive , qua mạng Can
và tín hiệu output
Đọc các sai số từ mạch Receive điều khiển khớp tay máy.
Lưu dữ liệu nhận được
Bật cớ ngắt
Truyền tín hiệu lên máy tính Tín hiệu cảm biến tiệm cận ? Ngắt Rs232 ? Dữ liệu nhận = 32 byte ? Err1 = 0 Err2 = 0 Err3 = 0 Err4 = 0 Err5 = 0
S S Đ S Đ S Đ S Đ
Hình 4.5: Lưu đồ giải thuật điều khiển cho Receive khớp tay máy
Start
Khai báo cấu hình hoạt động cho các chức năng : Can, Timer
Khai báo các biến, sự kiện ngắt.
Kích hoạt ngắt
Ngắt nhận tin nhắn Can.
Bắn xung và kích chân chiều vào driver để điều khiển góc quay động cơ.
Gởi tin nhắn cho Transmit Error = 0 ?
End
Ngắt nhận tin nhắn Can.
Kiểm tra địa chỉ tin nhắn ?
Dữ liệu nhận – 8 byte ?
Lưu dữ liệu data trong tin nhắn. Bật cờ ngắt Gởi tin nhắn Error cho Transmit Gởi tin nhắn hoàn thành cho Transmit Error = 0 ? Return
Start
Khai báo cấu hình hoạt động cho các chức năng input và Timer1
Khai báo các biến, sự kiện ngắt
Kích hoạt ngắt
Bắn xung điều khiển động cơ tay kẹp nhả
End
Nhận tín hiệu output của mạch Transmit
THỰC NGHIỆM, ĐÁNH GIÁ KẾT QUẢ CHƢƠNG 5:
5.1 Giới thiệu
5.1.1Mục tiêu, yêu cầu thực nghiệm
Kiểm tra hoạt động, độ ổn định của cơ cấu tay kẹp Kiểm tra hoạt động của các mạch điện.
Kiểm tra hoạt động của giải thuật gắp vật và chương trình điều khiển. Hiệu chỉnh.
5.1.2Các thành phần thí nghiệm
Mô hình khối lập phương mô phỏng thùng hàng cần gắp.
Hình 5.1: Mô hình khối lập phương
Đề tài được thực nghiệm trên mô hình cánh tay robot 5 bậc tự do.
5.2 Quá trình thực nghiệm
5.2.1Kiểm tra hoạt động của mạch điện, bài toán động học và di chuyển của cánh tay theo quỹ đạo.
Bằng cách sử dụng giao diện chương trình trên máy tính, đề tài tiến hành thực hiện việc điều khiển vị trí cho từng khớp, sau đó điều khiển cánh tay robot di chuyển theo quỹ đạo lắp ráp. Lúc này, ta đưa bảng làm việc đến vị trí lắp ráp rồi cho dừng lại để kiểm tra cánh tay robot có di chuyển đúng quỹ đạo, lắp ráp có chính xác và đúng thời gian mong muốn không.
Hình 5.3: Ảnh chụp trong quá trình robot gắp khối lập phương.
Theo quỹ đạo hoạch định cánh tay robot sẽ di chuyển từ tọa độ (250,0,-85) và kết thúc quỹ đạo lắp vật tại tọa độ (0,-250,-105) thời gian di chuyển là 1 phút 5 giây. Quỹ đạo có 56 điểm và thời gian di chuyển giữa các điểm là 1,2 giây tương ứng với thời gian mỗi lần gửi dữ liệu của máy tính xuống Transmit.
Hình 5.4: Kết quả gắp khối lập phương
Vùng gạch màu đen là vùng đặt mong muốn (kích thước 30mm X 30mm). Đường màu vàng là đường kẽ vị trí khối lập phương chiếm chỗ khi được robot gắp. Sai lệnh cho phép để đảm bảo việc sắp xếp đạt yêu cầu là sai lệch so với biên chuẩn nhỏ hơn 4mm .
Thực nghiệm được tiến hành 5 lần và cho kết quả: Bảng 5.1: Bảng khảo sát
Số lần
Sai số so với vị trí mong muốn (mm)
Thời gian thực hiện (s)
1 2,4 65
2 3,1 65
3 2,7 64
4 2,4 64
Thực nghiệm kiểm tra sai số lặp lại 5 lần liên tiếp.
Hình 5.5: Kết quả gắp khối lập phương lặp lại 5 lần liên tục.
5.2.2Kết quả
Mạch điện robot hoạt động tốt, mạch điều khiển đáp ứng được yêu cầu đặt ra. Robot di chuyển theo quỹ đạo mong muốn nhưng còn sai số. Việc còn lại là đồng bộ tốc độ di chuyển của bảng làm việc từ vị trí cảm biến tiệm cận đến vị trí lắp vật.
5.3 Đánh giá sai số
Nhìn chung kết quả lắp ráp là khá chính xác có thể gắp vật đúng vị trí mong muốn nhưng còn có sai số (sai số cao nhất là 3,1 mm tuy nhiên vẫn đảm bảo gắp khối lập phương vào đúng vị trí mong muốn, sai số nhỏ nhất là 2,4 mm). Sai số vị trí so với tọa độ cần tới tương đối lớn nhưng so với quỹ đạo di chuyển là nhỏ và do cánh tay di chuyển qua nhiều điểm tựa thuộc quỹ đạo nên sai số này chấp nhận được, vẫn đảm bảo gắp vật vào vị trí mong muốn thành công.
5.4 Kết luận
Những kết quả trên là những kết quả bước đầu nên còn thiếu sót và còn sai số trong quá trình điều khiển. Việc điều khiển robot vẫn chưa toàn diện cả vận tốc và vị trí nên cánh tay lúc di chuyển theo quỹ đạo vẫn còn khựng chưa đều và êm, ngoài ra chưa khử được sai số do độ rơ của các kết cấu cơ khí.
TỔNG KẾT VÀ HƢỚNG PHÁT TRIỂN ĐỀ TÀI CHƢƠNG 6:
6.1 Đánh giá kết quả đạt đƣợc 6.1.1Nội dung hoàn thành
Đề tài đã thực hiện được các nội dung đề ra trong phần nhiệm vụ, cánh tay robot có thể hoạt động và gắp khối lập phương di chuyển đúng với yêu cầu đề ra. Trong nội dung đề tài đã thực hiện được việc tổng quan về tình hình nghiên cứu và ứng dụng tay máy robot trong việc sắp xếp các thùng carton lên pallet, thiết kế mô hình cơ khí của băng tải, tay gắp và tiến hành gia công chết tạo, thiết kế mạch điện điều khiển, giao diện giao tiếp giữa máy tính và robot, xây dựng được mạng giao tiếp CAN ổn định và ít sai số, giải thuật điều khiển cánh tay robot lắp vật khối hộp lập phương, lắp mô hình, chạy thực nghiệm hệ thống và đánh giá kêt quả thu được.
6.1.2Hạn chế của đề tài
Trong quá trình thực hiện đề tài, nhận thấy có những vấn đề phát sinh và chưa được khắc phục triệt đó là sai số do độ rơ cơ khí, sai số chế tạo tay kẹp dẫn đến kết quả lắp ráp có sai số. Trong thực nghiệm chỉ dừng lại ở việc điều khiển vị trí chưa thực hiện được điều khiển vận tốc do đó cánh tay robot di chuyển không thể êm mượt mà còn bị khựng lại giữa 2 đoạn điểm tựa trong quĩ đạo.
6.2 Hƣớng phát triển của đề tài
Dựa trên những hạn chế của đề tài, ta có được những định hướng phát triển trong tương lai như sử dụng vi điều khiển có tốc độ cao để xử lý cao hơn để đọc chính xác số liệu encoder. Từ đó có thể kiểm tra driver có điều khiển vị trí chính xác như nhận xung điều khiển từ vi điều khiển không . Sử dụng phương pháp khử rơ về cả cơ khí lẫn mạch điện nhằm tăng độ chính xác cho việc điều khiển hệ thống. Áp dụng vòng điều khiển vận tốc để cánh tay robot có thể hoạt động êm và ổn định hơn.
TÀI LIỆU THAM KHẢO
[1] John J.Craig. (2005). Introduction to Robotics, Mechanical and Control, third edition, Pearson Education International.
[2] Nguyễn Mạnh Tiến. (2007). Điều khiển robot công nghiệp. Nhà xuất bản Khoa học và kỹ thuật.
[3] Nguyễn Thiện Phúc. (2006). Robot công nghiệp. Nhà xuất bản Khoa học và kỹ thuật.
[4] Nguyễn Hữu Lộc. (2012). Cơ sở thiết kế máy. Nhà xuất bản Đại Học Quốc Gia Thành Phố Hồ Chí Minh.
[5] Peter Corke,Robotics. (2008). Vision and Control,Fundamental Algorithms in Matlab.
[6] Trịnh Chất, Tính toán thiết kế Hệ dẫn động Cơ khí Tập 1. Nhà xuất bản Giáo Dục Việt Nam,
[7] Trịnh Chất. (2010) Tính toán thiết kế Hệ dẫn động Cơ khí Tập 2. Nhà xuất bản Giáo Dục Việt Nam.
[8] Phạm Đăng Phước. (2007). Giáo trình Robot Công Nghiệp. NXB Xây Dựng Hà Nội.
[9] Reza N. Jazar, Theory of Applied Robotics,Kinematics,Dynamics,and Control Second Edition.
[10] Advisors, Dr. Hatem Elaydi and Dr.Iyad Abuhadrous. (2011). Simulation and Interfacing of 5 DOF Educational Robot Arm, A master thesis.