ĐẠI HỌC QUỐC GIA THÀNH PHỐ HỒ CHÍ MINH TRƯỜNG ĐẠI HỌC BÁCH KHOA KHOA CƠ KHÍ BỘ MÔN CƠ ĐIỆN TỬ BÁO CÁO ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ Giảng viên hướng dẫn: Ths. Phạm Phương Tùng SINH VIÊN THỰC HIỆN MSSV Châu Nhật Quang 1910478 Đặng Thanh Trí 1910633 Chu Thanh Tùng 1910678 Đặng Trường Vũ 1910699 Thành phố Hồ Chí Minh, tháng 12 năm 2022 ĐẠI HỌC QUỐC GIA THÀNH PHỐ HỒ CHÍ MINH TRƯỜNG ĐẠI HỌC BÁCH KHOA KHOA CƠ KHÍ BỘ MÔN CƠ ĐIỆN TỬ BÁO CÁO ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ ĐỀ TÀI: ROBOT DÒ LINE TRÁNH VẬT CẢN Giảng viên hướng dẫn: Ths. Phạm Phương Tùng SINH VIÊN THỰC HIỆN MSSV Châu Nhật Quang 1910478 Đặng Thanh Trí 1910633 Chu Thanh Tùng 1910678 Đặng Trường Vũ 1910699 Thành phố Hồ Chí Minh, tháng 12 năm 2022 PHÂN CÔNG NHIỆM VỤ ST Họ và tên Nhiệm vụ T 1 Châu Nhật Quang Xây dựng lưu đồ giải thuật Lập trình vi điều khiển Lập bản vẽ giải thuật Thực nghiệm 2 Đặng Thanh Trí Thiết kế cơ khí Xây dựng mô hình 3D Lập bản vẽ cơ khí Thực nghiệm 3 Chu Thanh Tùng Nhóm trưởng Tổng quan phương án Thực hiện và hiệu chỉnh mô hình thực tế Lập bản vẽ phương án Thực nghiệm 4 Đặng Trường Vũ Thiết kế hệ thống điện Mô hình hóa hệ thống Xây dựng bộ điều khiển Mô phỏng Lập bản vẽ hệ thống điện LỜI CẢM ƠN Nhóm thực hiện đồ án xin gửi lời cảm ơn chân thành đến thầy Phạm Phương Tùng, người trực tiếp hướng dẫn nhóm trong suốt quá trình thực hiện đồ án này. Thầy đã hướng dẫn tận tình, tận tâm và sự chỉ bảo nhiệt tình của thầy đã giúp nhóm vượt qua được nhiều vấn đề khó khăn.
Ngoài ra, nhóm cũng muốn gửi lời cảm ơn đến các bạn bè trong tập thể lớp CK19CD1 đã cùng đồng hành và trợ giúp cho nhóm trong những lúc khó khăn, góp phần giúp nhóm hoàn thành đồ án này. Nhóm sinh viên thực hiện Châu Nhật Quang Đặng Thanh Trí Chu Thanh Tùng Đặng Trường Vũ TÓM TẮT ĐỒ ÁN Đồ án Thiết kế hệ thống Cơ điện tử cung cấp cho sinh viên cái nhìn tổng quan và quy trình thực nghiệm trong việc thiết kế hoàn chỉnh một hệ thống có điện tử trong thực tế. Sinh viên phải vận dụng toàn bộ những kiến thức đã học được trong các lĩnh vực cơ khí, điện tử, điều khiển và lập trình để phân tích, tính toán và triển khai thực nghiệm nội dung đồ án. Việc thực hiện đồ án yêu cầu sinh viên thực hiện quá trình thiết kế theo những bước tuần tự bao gồm khảo sát thực tế, so sánh, đánh giá và lựa chọn phương án cho đề tài.
Sau khi chọn được phương án thiết kế, sinh viên tiến hành thiết kế các hệ thống điện, cơ khí và giải thuật điều khiển, các công việc này được thực hiện một cách đồng thời và hỗ trợ cho nhau trong suốt quá trình thực hiện đồ án. Khi quá trình tính toán thiết kế được hoàn tất, sinh viên tiến hành mô phỏng và triền khai thực nghiệm để đánh giá, nhận xét về tính khả thi của đề tài, từ đó đưa ra phương hướng cải tiến để phù hợp với điều kiện thực tế. Thông qua đồ án, sinh viên sẽ rèn luyện được khả năng tư duy phân tích, khả năng làm việc nhóm và khả năng triển khai thực nghiệm. Những kiến thức và kĩ năng ấy chính là nền tảng để sinh viên có thể học hỏi, rèn luyện trong môi trường công việc sau này.
MỤC LỤC PHÂN CÔNG NHIỆM VỤ. iii DANH MỤC HÌNH ẢNH.vii DANH MỤC BẢNG BIỂU. TỔNG QUAN VỀ ĐỀ TÀI. Giới thiệu về robot dò line (AGV).
Một số loại robot dò line phổ biến. Yêu cầu thiết kế. PHƯƠNG ÁN THIẾT KẾ. Kết cấu cơ khí.
Số lượng bánh xe. Vị trí đặt bánh chủ động. Động cơ dẫn động. Cơ cấu cảm biến.
Cảm biến hồng ngoại. Cảm biến phát hiện vật cản. Cấu trúc điều khiển. Giải thuật điều khiển.
THIẾT KẾ CƠ KHÍ. Bánh chủ động. Bánh xe bị động. Tính toán chọn động cơ dẫn động.
Thiết kế khung robot. THIẾT KẾ HỆ THỐNG ĐIỆN. Tổng quan thiết bị. Cảm biến dò line.
Vi điều khiển. Driver điều khiển động cơ DC. Thiết kế dãy cảm biến. Số lượng cảm biến.
Khoảng cách đến mặt sa bàn của cảm biến. Khoảng cách giữa 2 module cảm biến. Calibrate cảm biến. Cảm biến siêu âm.
Công suất và pin. MÔ HÌNH HÓA HỆ THỐNG. Phương trình động học của robot. Khảo sát đặc tính động cơ.
Xác định thời gian lấy mẫu. Khảo sát khoảng tuyến tính động cơ. Khảo sát đáp ứng để tìm hàm truyền động cơ. THIẾT KẾ BỘ ĐIỀU KHIỂN.
Thiết kế bộ điều khiển PID cho động cơ. Tiêu chí thiết kế bộ điều khiển. Tính toán các thông số hàm truyền cho bộ điều khiển PID. Thiết kế luật điều khiển.
MÔ PHỎNG HOẠT ĐỘNG CỦA ROBOT VÀ THỰC NGHIỆM. Mô phỏng đường line. Mô phỏng robot bám line. Kết quả thực nghiệm.56 TÀI LIỆU THAM KHẢO.57 DANH MỤC HÌNH ẢNH Hình 1.
AGV dò line hoạt động trong nhà kho [1]. Robot dò line trong một cuộc thi học thuật. Sa bàn Hình 2. Cấu trúc ba bánh (a,b,c); cấu trúc bốn bánh (d,e,f); dẫn động bánh trước (b,c); dẫn động bánh sau (a,d,e,f) [4].
Hai dạng chính của cấu trúc khung xe ba bánh. Một số cơ cấu cảm biến [5]. Camera CMU Pixy 5 [6]. Nguyên lý hoạt động của cảm biến hồng ngoại [7].
Các cảm biến hồng ngoại và thanh cảm biến hồng ngoại [5]. Một số cách sắp xếp cảm biến thông dụng. Xử lý tín hiệu bằng phương pháp so sánh [4]. Xử lý tín hiệu bằng phương pháp xấp xỉ [4].
Cảm biến hồng ngoại [8]. Cảm biến siêu âm [9]. Cấu trúc điều khiển của robot bám line [4]. Vị trí robot trong hệ tọa độ Descartes.
Bánh xe chủ động của robo bám line. Bánh mắt trâu. Mô hình động lực học của bánh xe dẫn động. Các lực tác động lên thân robot.
Sơ đồ phân tích động lực học robot. Các kích thước cơ sở. Thiết kế 3D theo hướng nhìn từ trước của robot. Thiết kế 3D theo hướng nhìn từ cạnh của robot.
Thiết kế 3D theo hướng nhìn từ trên của robot. Thiết kế 3D của robot 3 Hình 4. Module cảm biến hồng ngoại TCRT5000 [11]. Ngưỡng hoạt động của cảm biến.
Khoảng cách tối thiểu giữa 2 cảm biến kề nhau. Trường hợp vùng phát hiện của 2 cảm biến nằm trong line. Module giảm áp LM2596 [16]. Module giảm áp Buck XL4015 [17] 3 Hình 5.
Mô hình động học robot. Mối quan hệ giữa độ rộng xung và tốc độ. Tín hiệu đầu vào 2 động cơ. Hàm truyền xấp xỉ của hai động cơ.
Mức độ chính xác của hàm truyền so với thực nghiệm 4 Hình 6. Sơ đồ điều khiển vòng kín. Mô hình động học của robot 4 Hình 7. Sa bàn dò line.
Mô phỏng sa bàn. Quá trình chuyển động của robot. Sai số bám line. Mô hình robot thực tế.55 DANH MỤC BẢNG BI Bảng 3.
Thông số động cơ DC Servo GM25 – 370. Tỷ lệ chiều dài của các xe ô tô. Tỷ lệ kích thước theo đường kính bánh xe của các xe ô tô. Các kích thước tổng quát của robot.
Thông số kỹ thuật cảm biến hồng ngoại TCRT5000 [10]. Thông số kỹ thuật driver L298N [13]. Thông số kỹ thuật module cảm biến siêu âm HC-SRF04 [15]. Năng lượng tiêu thụ của các thiết bị điện 3 Bảng 7.
Thông số mô phỏng. TỔNG QUAN VỀ ĐỀ TÀI 1. Giới thiệu về robot dò line (AGV) Robot dò line là một dạng của robot di động và được thiết kế để bám theo một quỹ đạo cho trước. Hiện nay, robot dò line đã được ứng dụng rất nhiều trong cả lĩnh vực công nghiệp lẫn giáo dục.
Trong công nghiệp, robot dò line thường được biết đến với tên gọi AGV (Automated Guided Vehicle) (hình 1.1) và việc ứng dụng nó đã thay đổi cách mà các kho hàng được sắp xếp và vận hành trên toàn thế giới. Trong lĩnh vực giáo dục, robot dò line (hình 1.2) được sử dụng để dạy cho các sinh viên đặc biệt là các sinh viên chuyên ngành cơ điện tử cách thức thiết kế, chế tạo và vận hành một hệ thống cơ điện tử. AGV dò line hoạt động trong nhà kho [1] Hình 1. Robot dò line trong một cuộc thi học thuật Hiện nay, các cuộc thi về robot dò line đã được tổ chức với số lượng và chất lượng ngày càng tăng nhằm mục đích khuyến khích sinh viên vận dụng những gì đã được học áp dụng vào giải quyết các vấn đề của cuộc thi đặt ra.
Phương châm “Learn by doing” đã được chứng minh là giúp sinh viên hiểu sâu và có khả năng áp dụng linh hoạt những gì mình được học. Các cuộc thi nổi tiếng về robot dò line có thể kể đến như: cuộc thi LVBots Line following được tổ chức bởi Pololu, cuộc thi Robotchallenge 2015 Line Follower & Line Follower Enhanced và nhiều cuộc thi khác. Một số loại robot dò line phổ biến 1. Robot uXbots Robot uXbots là robot có cấu trúc ba bánh vi sai với hai bánh dẫn động được đặt phía sau.
Nó được tạo ra với mục đích giáo dục và đã tham gia cuộc thi Hispabots Competition và Robolid Competition được tổ chức ở Tây Ban Nha. uXbots có những đặc điểm như: - Dẫn động bằng hai động cơ DC Maxon - Vận tốc tối đa: 3 �⁄� - Sử dụng cảm biến hồng ngoại và cảm biến quán tính IMU - Giải thuật học đường đi và giải thuật thích nghi Hình 1. Robot Chariot Robot đã tham gia cuộc thi LVBots Line Following Competition được tổ chức bởi Pololu vào tháng 4 năm 2015. Chariot có hình dáng như tên gọi của nó, là “một chiếc xe kỵ binh” (hình 1.4) đạt tốc độ lớn nhất là 1,17 �/� và giành được giải nhì trong cuộc thi đó.
Một số đặc điểm của Robot Chariot như: - Dẫn động bằng hai động cơ DC Pololu 15,5D - Vận tốc tối đa: 1,17 m/s - Sử dụng thanh cảm biến hồng ngoại QTR – 8RC - Giải thuật điều khiển PID 1. Yêu cầu thiết kế Thiết kế robot di chuyển bám line trên sa bàn, phát hiện vật cản trên đường đi và di chuyển vòng qua vật cản với các đặc tính: - Nền sa bàn có màu trắng - Đường dẫn có màu đen - Bề rộng đường dẫn: 26 mm - Di chuyển trong mặt phẳng Hình 1. Robot Chariot [3] - Tốc độ di chuyển thấp nhất: 0,1 m/s - Sai số bám đường dẫn (tính từ mép trái hoặc mép phải của đường line): 3 mm - Sai số vị trí dừng cuối đường dẫn là 5 mm - Vật cản là khối trụ có đường kính tiết diện 50 mm Hình 1. Sa bàn Chương 2.
PHƯƠNG ÁN THIẾT KẾ 2.