Thiết kế, chế tạo robot 04 bậc tự do mô phỏng chuyển động trên tàu thủy

ĐẠI HỌC QUỐC GIA HÀ NỘI TRƯỜNG ĐẠI HỌC CÔNG NGHỆ ĐẶNG VĂN MƯỜI THIẾT KẾ, CHẾ TẠO ROBOT 04 BẬC TỰ DO MÔ PHỎNG CHUYỂN ĐỘNG TRÊN TÀU THỦY LUẬN VĂN THẠC SĨ CÔNG NGHỆ KỸ THUẬT ĐIỆN TỬ, TRUYỀN THÔNG HÀ NỘI - 2017 ĐẠI HỌC QUỐC GIA HÀ NỘI TRƯỜNG ĐẠI HỌC CÔNG NGHỆ ĐẶNG VĂN MƯỜI THIẾT KẾ, CHẾ TẠO ROBOT 04 BẬC TỰ DO MÔ PHỎNG CHUYỂN ĐỘNG TRÊN TÀU THỦY Ngành: Công nghệ kỹ thuật điện tử, truyền thông Chuyên ngành: Kỹ thuật điện tử Mã số: 60520203 LUẬN VĂN THẠC SĨ CÔNG NGHỆ KỸ THUẬT ĐIỆN TỬ, TRUYỀN THÔNG NGƯỜI HƯỚNG DẪN KHOA HỌC: TS NGUYỄN THĂNG LONG HÀ NỘI - LỜI CẢM ƠN Luận văn hoàn thành với hỗ trợ đề tài độc lập cấp nhà nước mã số ĐTĐL.CN-02/2017 đề tài cấp Đại học Quốc gia Hà Nội mã số QG.16.28 Để hoàn thành luận văn này, ngồi nỗ lực thân, tơi cịn nhận giúp đỡ nhiệt tình từ phía nhà trường, cán hướng dẫn, gia đình, cơng ty bạn bè Tôi xin gửi lời cảm ơn chân thành sâu sắc đến: TS Nguyễn Thăng Long, Bộ môn vi điện tử vi hệ thống, Khoa Điện Tử Viễn Thông, Trường Đại học Công nghệ - Đại học Quốc gia Hà Nội tận tình hướng dẫn tơi suốt q trình làm luận văn Trường Đại học Công nghệ - Đại học Quốc gia Hà Nội tạo điều kiện cho học tập, nghiên cứu tạo tiền đề vững cho tơi hồn thành khóa luận Cuối tơi xin gửi lời cảm ơn đến gia đình tất bạn bè ln bên, ủng hộ tơi để hồn thành khóa luận Tôi xin chân thành cảm ơn! Hà Nội, ngày 29 tháng 12 năm 2017 Đặng Văn Mười LỜI CAM ĐOAN Tơi xin cam đoan, luận văn cơng trình nghiên cứu tơi, có hỗ trợ từ cán hướng dẫn TS Nguyễn Thăng Long thành viên nhóm nghiên cứu Nội dung nghiên cứu luận văn khơng chép cơng trình nghiên cứu người khác Ngồi ra, luận văn cịn sử dụng thơng tin, hình vẽ, số liệu thu thập từ nhiều nguồn khác rõ phần tài liệu tham khảo Nếu có gian lận nào, tơi xin chịu hồn tồn trách nhiệm trước hội đồng nhà trường kết luận văn Hà Nội, ngày 29 tháng 12 năm 2017 Học viên Đặng Văn Mười MỤC LỤC DANH MỤC HÌNH VẼ iii DANH MỤC BẢNG BIỂU v MỞ ĐẦU .1 TỔNG QUAN .3 1.1 TỔNG QUAN VỀ XÂY DỰNG MƠ HÌNH u cầu xây dựng mơ hình Biểu diễn phương hướng vật thể .4 1.2 TỔNG QUAN VỀ ROBOT Giới thiệu phân loại robot 1.2.1.a Phân loại theo dạng hình học khơng gian hoạt động .5 1.2.1.b Phân loại theo hệ .6 1.2.1.c Phân loại theo nguồn dẫn động .6 1.2.1.d Phân loại theo kết cấu động học .7 Robot song song ứng dụng THIẾT KẾ CƠ KHÍ 2.1 TÍNH TỐN, LỰA CHỌN MƠ HÌNH Đánh giá mơ hình robot có sẵn thị trường Lựa chọn mơ hình robot song song 10 Mơ hình robot song song bậc tự 11 2.2 THIẾT KẾ VÀ CHẾ TẠO 13 Giới thiệu phần mềm Solidworks 13 Thiết kế, mô chế tạo .14 THIẾT KẾ ĐIỆN TỬ 17 3.1 THIẾT KẾ, LỰA CHỌN THIẾT BỊ 17 Tính tốn, lựa chọn động 17 Tính tốn, lựa chọn encoder 19 Cảm biến chuyển động MPU 6050 20 Bộ KIT điều khiển Arduino MEGA 2560 21 Mạch điều khiển động DC 23 Nguồn điện 24 3.2 MẠCH ĐIỆN VÀ CÁCH GHÉP NỐI 25 THIẾT KẾ CHƯƠNG TRÌNH ĐIỀU KHIỂN .27 4.1 SƠ ĐỒ THUẬT TOÁN 27 4.2 THUẬT TOÁN PID VÀ BỘ LỌC SỐ 28 Thuật toán PID .28 4.2.1.a Giới thiệu thuật toán PID 28 4.2.1.b Ứng dụng điều khiển PID cho robot bậc tự 31 4.2.1.c Lựa chọn thông số PID 32 4.2.1.d Thử nghiệm thực tế thông số PID 34 Bộ lọc số .41 4.2.2.a Bộ lọc số Kalman 42 4.2.2.b Bộ lọc số Complementary 42 KẾT QUẢ THỰC TẾ VÀ PHƯƠNG HƯỚNG PHÁT TRIỂN 44 5.1 KẾT QUẢ THỬ NGHIỆM THỰC TẾ .44 Thử nghiệm tốc độ xử lý vi điều khiển 44 Thử nghiệm giá trị bước dịch chuyển 44 Thử nghiệm bám vị trí động .45 5.2 PHƯƠNG HƯỚNG PHÁT TRIỂN .47 Đối với thiết kế khí 48 Đối với thiết kế điện tử 48 Đối với thiết kế chương trình điều khiển .48 TÀI LIỆU THAM KHẢO 50 PHỤ LỤC 52 DANH MỤC HÌNH VẼ Hình 1.1 Mơ chuyển động tàu thủy phương pháp thủ cơng .3 Hình 1.2 Phép biểu diễn Euler .4 Hình 1.3 Biểu diễn góc nghiêng, góc ngẩng góc cuộn Hình 1.4 Robot song song hexapod Eric Gough .8 Hình 1.5 Các ứng dụng robot song song Hình 2.1 Các mơ hình có sẵn thị trường Hình 2.2 Hình ảnh thực tế robot bậc tự 10 Hình 2.3 Mơ hình tốn học robot bậc tự .10 Hình 2.4 Robot bậc tự trạm thu phát sóng di động 12 Hình 2.5 Solidworks 2017 13 Hình 2.6 Động tuyến tính (linear motor) 14 Hình 2.7 Động trục quay 14 Hình 2.8 Đế cố định động tuyến tính 15 Hình 2.9 Bàn động .15 Hình 2.10 Mâm xoay gắn bàn động 16 Hình 2.11 Mơ hình hồn thiện robot bậc tự 16 Hình 3.1 Động tuyến tính 18 Hình 3.2 Động quay 18 Hình 3.3 Encoder 334 xung/vòng 20 Hình 3.4 Cảm biến chuyển động MPU 6050 .20 Hình 3.5 KIT Arduino Mega 2560 22 Hình 3.6 Mạch điều khiển động 24 Hình 3.7 Nguồn xung 24V DC – 10A 24 Hình 3.8 Nguồn xung 12V DC – 1A 25 Hình 3.9 Sơ đồ ghép nối hệ thống .25 Hình 4.1 Sơ đồ thuật toán 27 Hình 4.2 Tác động hệ số tỉ lệ tới đầu hệ thống 29 i Hình 4.3 Tác động hệ số tích phân tới đầu hệ thống 30 Hình 4.4 Tác động hệ số vi phân tới đầu hệ thống .30 Hình 4.5 Sơ đồ khối điều khiển PID 31 Hình 4.6 Thử nghiệm với giá trị Kp = 20, Ki = 0, Kd = 34 Hình 4.7 Thử nghiệm với giá trị Kp = 30, Ki = 0, Kd = 35 Hình 4.8 Thử nghiệm với giá trị Kp = 40, Ki = 0, Kd = 35 Hình 4.9 Thử nghiệm với giá trị Kp = 50, Ki = 0, Kd = 36 Hình 4.10 Thử nghiệm với giá trị Kp = 60, Ki = 0, Kd = 36 Hình 4.11 Thử nghiệm với giá trị Kp = 15, Ki = 2, Kd = 37 Hình 4.12 Thử nghiệm với giá trị Kp = 15, Ki = 10, Kd = .38 Hình 4.13 Thử nghiệm với giá trị Kp = 15, Ki = 20, Kd = .38 Hình 4.14 Thử nghiệm với giá trị Kp = 15, Ki = 30, Kd = .39 Hình 4.15 Thử nghiệm với giá trị Kp = 15, Ki = 20, Kd = 10 .40 Hình 4.16 Thử nghiệm với giá trị Kp = 15, Ki = 20, Kd = 10 .40 Hình 4.17 Thử nghiệm với giá trị Kp = 15, Ki = 20, Kd = 30 .41 Hình 4.18 Sơ đồ lọc bù 43 i DANH MỤC BẢNG BIỂU Bảng 2.1 So sánh chi phí mơ hình robot song song Bảng 2.2 So sánh thơng số mơ hình robot song song 11 Bảng 5.1 Thử nghiệm tốc độ xử lý vi điều khiển 44 Bảng 5.2 Giá trị bước dịch chuyển động 45 Bảng 5.3 Thử nghiệm bám vị trí động – Lần 45 Bảng 5.4 Thử nghiệm bám vị trí động – Lần 45 Bảng 5.5 Thử nghiệm bám vị trí động – Lần 46 Bảng 5.6 Thử nghiệm bám vị trí động – Lần 46 Bảng 5.7 Thử nghiệm bám vị trí động – Lần 46 v MỞ ĐẦU Tính cấp thiết đề tài: Robot bậc tự mơ hình robot song song thiết kế xây dựng để đáp ứng yêu cầu mô hình hóa, mơ lại chuyển động thực tế tàu thuyền, máy bay, phương tiện giao thông Với hiệu lớn thực tiễn để phục vụ mục đích nghiên cứu, diễn tập, giải trí hệ thống robot bậc tự ngày ứng dụng nhiều Cụ thể đề tài này, hệ thống robot bậc tự sử dụng để mô lại chuyển động tàu thủy với mục đích kiểm tra, hồn thiện tính hoạt động; chạy thử kiểm định thiết bị điều kiện chuyển động với thông số khác phịng thí nghiệm Việc chế tạo hệ thống robot cần thiết để phục vụ nghiên cứu chạy thử nghiệm hệ thống phịng thí nghiệm trước cho vận hành điều kiện thực tế để kiểm sốt tối ưu thơng số thiết bị Chế tạo robot bậc tự nhiệm vụ đặt đề tài “Nghiên cứu phát triển sản phẩm thương mại hóa trạm thu di động tín hiệu truyền hình vệ tinh ứng dụng tàu biển” (QG.16.89) nhóm nghiên cứu trường Đại học Công nghệ, Đại học Quốc gia Hà Nội thực chủ trì GS.TS Nguyễn Hữu Đức Đề tài phát triển từ đề tài nghiên cứu chương trình Khoa học Công nghệ Vũ trụ tiếp tục đầu tư để phát triển thành sản phẩm thương mại Để hoàn thiện sản phẩm thương mại việc đo đạc kiểm định hoạt động hệ thống điều kiện rung lắc, chuyển động với vận tốc, gia tốc khác theo yêu cầu đặt khó thực điều kiện thực tế tàu biển phụ thuộc vào thời tiết Thêm vào đó, việc chạy thử nghiệm điều kiện dã ngoại địi hỏi chi phí cao xác suất rủi ro thất bại cao không vận hành thử nghiệm tốt phịng thí nghiệm với điều kiện tương tự Chính lý này, luận văn đặt đề tài Thiết kế, chế tạo robot bậc tự mô chuyển động tàu thủy với mục tiêu tạo chuyển động chuyển động thực tàu thủy không gian chiều với thông số chuyển động khác phục vụ chạy thử thiết bị Trạm thu di động thông tin vệ tinh Sản phẩm thiết kế chế tạo luận văn tiếp tục nghiên cứu phát triển hướng tới ứng dụng nhiều lĩnh vực khác nghiên cứu thực tiễn Ý nghĩa khoa học thực tiễn: Việc chạy thử nghiệm hệ thống trạm thu di dộng thông tin vệ tin phịng thí nghiệm mơ chạy thật tàu biển với chế độ rung, lắc, nghiêng,