ĐỒ án môn học THIẾT kế hệ THỐNG cơ điện tử THIẾT kế, CHẾ tạo và điều KHIỂN ROBOT XE ĐUA dò LINE

TRƯỜNG ĐẠI HỌC BÁCH KHOA KHOA CƠ KHÍ BỘ MƠN CƠ-ĐIỆN TỬ  ĐỒ ÁN MÔN HỌC THIẾT KẾ HỆ THỐNG CƠ-ĐIỆN TỬ HỌC KÌ II, NĂM HỌC 2016-2017  ĐỀ TÀI: THIẾT KẾ, CHẾ TẠO VÀ ĐIỀU KHIỂN ROBOT XE ĐUA DÒ LINE   GVHD: PGS.TS NGUYỄN TẤN TIẾN SVTH: NHÓM 1 HỒ LÊ TẤN BẢO LÊ MINH ĐỨC NGUYỄN HOÀNG HUY NGUYỄN HỮU HUY TP HỒ CHÍ MINH, NGÀY 13 THÁNG 05 NĂM 2017 MỤC LỤC YÊU CẦU MỤC TIÊU .1 CHƯƠNG 1: TỔNG QUAN Về Cơ Khí Mơ hình xe đua dò line nước 2 Mơ hình xe đua dị line nước 3 So sánh ưu, nhược điểm Về Điện Về cảm biến Về động Về Cấu Trúc Điều Khiển Về Bộ Điều Khiển 10 ĐẶT ĐỀ BÀI 10 CHƯƠNG 2: LỰA CHỌN PHƯƠNG ÁN .12 Về Cơ Khí 12 Phương án khả thi .12 Lựa chọn phương án 12 Về Điện 12 Lựa chọn động .12 Lựa chọn cảm biến 13 Về Cấu Trúc Điều Khiển 13 Về Bộ Điều Khiển 13 CHƯƠNG 3: THIẾT KẾ 14 Thiết Kế Cơ Khí .14 Tính tốn kích thước xe 14 Tính tốn cơng suất động .17 Tính tốn moment xoắn động 18 Dung sai 19 Thiết Kế Điện 25 Thiết kế cảm biến 25 Lựa chọn nguồn 30 Khối động cơ-driver 31 Thiết Kế Phần Lập Trình 36 Sơ đồ khối hệ thống điều khiển 36 Chọn vi điều khiển 36 Lưu đồ giải thuật .37 Mơ Hình Hóa 39 Mơ hình hóa động học 39 Thiết kế điều khiển 40 Mơ hình hóa cảm biến 40 Cách tìm sai số 40 Mơ hình hóa động 41 Kết mô .42 Nhận xét 45 CHƯƠNG 4: KẾT QUẢ THỰC NGHIỆM 46 Kết Quả Thực Nghiệm 46 Phân Tích Thực Nghiệm 48 Đề Xuất Hiệu Chỉnh Thiết Kế 48 CHƯƠNG 5: BIỂU ĐỒ GANLT 49 TÀI LIỆU THAM KHẢO 51 Đồ án TKHT Cơ-Điện Tử Xe Đua Dị Line U CẦU Đồ án mơn học (ĐAMH) Thiết Kế Hệ Thống Cơ-Điện Tử yêu cầu nhóm sinh viên thực hồn chỉnh q trình thiết kế, chế tạo điều khiển Robot Xe Đua Dị Line (Line Following Robot) Robot sau hồn thành phải di chuyển bám theo sa bàn line phẳng cho trước (hình H.1), theo thứ tự (START) A → B → C → D → E → F → C → G → A → C → E (END), với vận tốc không nhỏ 0.2 / F 500 E END D 1500 3000 H.1 Sa bàn di chuyển robot MỤC TIÊU Do yêu cầu ĐAMH thiết kế, chế tạo điều khiển robot xe đua dò line nên mục tiêu quan trọng q trình xe đua dị line chạy nhanh Nhóm 1 Đồ án TKHT Cơ-Điện Tử Xe Đua Dò Line CHƯƠNG 1: TỔNG QUAN Về Cơ Khí Mơ hình xe đua dị line nước a Robot Không Độ đội Không Độ vô địch BCR 2013    Sơ đồ nguyên lí (a) (b) H (a) Robot Không Độ; (b) Sơ đồ kết cấu Robot Khơng Độ Kích thước: ×× = 270 × 140 × 140 ( ) Số bánh xe: Xe có bánh, bánh cao su dẫn động ( = 50 ( )) đường kính lớn đặt phía sau, bánh cao su có đường kính nhỏ đặt phía trước thực chức rẽ hướng, phần phận cảm biến tiếp xúc trực tiếp với đường line khơng có bi lăn bánh mắt trâu  Vận tốc xe: Vận tốc cực đại = 0.6 ( / ), vận tốc trung bình = 0.4 ( / ) b Robot TDC1 đội TDC1 vô địch MCR 2014    20 ( Sơ đồ nguyên lí (a) (b) H (a) Robot TDC1; (b) Sơ đồ kết cấu Robot TDC1 Kích thước: ×× = 24 × 160 × 80 ( ) Số bánh xe: Xe có bánh, bánh cao su ( = 40 ( )) dẫn động đặt phía sau, bánh cao su có đường kính nhỏ ( = )) đặt phía trước thực chức rẽ hướng, phần phận cảm biến tiếp xúc trực tiếp với đường line khơng có bi lăn bánh mắt trâu  Vận tốc xe: Vận tốc cực đại = 0.7 ( / ), vận tốc trung bình = 0.4 ( / ) c Robot BKC] đội BKC vơ địch BCR 2015 Nhóm Đồ án TKHT Cơ-Điện Tử   Xe Đua Dị Line Sơ đồ ngun lí (a) (b) H (a) Robot BKC; (b) Sơ đồ kết cấu Robot BKC Kích thước: ×× = 300 × 150 × 100 ( )  Số bánh xe: Xe có bánh, bánh cao su ( = 40 ( )) dẫn động đặt phía sau, bánh cao su tự lựa có đường kính lớn ( = 50 ( )) đặt phía trước thực chức bánh castor, phần phận cảm biến tiếp xúc trực tiếp với đường line khơng có bi lăn bánh mắt trâu  Vận tốc xe: Vận tốc cực đại = 0.7 ( / ), vận tốc trung bình = 0.5 ( / ) Mơ hình xe đua dị line ngồi nước a Robot Pika đội Mechatron vô địch Cyberbot 2015, Poznan   Sơ đồ nguyên lí (a) (b) H (a) Robot Pika; (b) Sơ đồ kết cấu Robot Pika Kích thước: ×× = 280 × 180 × 50 ( )  Số bánh xe: Xe ó bánh, bánh cao su dẫn động ( chức bánh castor  = 34 ( )) đặt khung chính, bánh mắt trâu đặt dãy cảm biến thực Vận tốc xe: Vận tốc cực đại = 2.7 ( / ), vận tốc trung bình = 1.9 ( / ) b Robot Green Gaint V4.1 thi Micromouse 2013-2014  Nhóm Sơ đồ ngun lí Đồ án TKHT Cơ-Điện Tử H Xe Đua Dò Line (a)   Kích thước: ×× = 190 × 110 × 40 ( ) Số bánh xe: Xe có bánh, bánh cao su phía trước dẫn động ( = 40 (  Vận tốc xe: Vận tốc cực đại ( / ) c (b) (a) Robot Green Gaint V4.1; (b) Sơ đồ kết cấu Green Gaint V4.1 )), bánh cao su phía sau bánh castor = 3.5 ( / ), vận tốc trung bình Robot RR Khoa Điện - Điện tử trường Đại học Manchester  Sơ đồ nguyên lí (b) (a) H (a) Robot RR; (b) Sơ đồ kết cấu Robot RR  Kích thước: = 160 × 100 × 80 ( ) ×   d × Số bánh xe: Xe có bánh, bánh cao su phía sau dẫn động ( = 54( Robot Dave đội đua Bruce thi LVBots Line Following, 4/2015 (a)  Nhóm )), bánh cao su phía trước có chức rẽ hướng Vận tốc xe: Vận tốc cực đại = ( / ), vận tốc trung bình = 0.5 ( / ) Sơ đồ nguyên lí = Đồ án TKHT Cơ-Điện Tử  Kích thước: × Xe Đua Dị Line × = 200 × 90 × 60 ( )  hướng Số bánh xe: Xe có bánh, bánh cao su phía sau (  Vận tốc xe: Vận tốc cực đại = 1.2 ( / ), vận tốc trung bình = 0.7 ( / ) = 60 ( )) truyền chuyển động từ vi sai, bánh mắt trâu phía trước có chức rẽ e Robot Pinto đội đua Grant thi LVBots Line Following, 4/2015  Sơ đồ nguyên lí (a) (b) H (a) Robot Pinto; (b) Sơ đồ kết cấu Robot Pinto Kích thước: × × = 210 × 130 × 120 (  castor Số bánh xe: Xe có bánh, bánh cao su phía trước ( = 60 (  Vận tốc xe: Vận tốc cực đại = 0.8 ( / ), vận tốc trung bình = 0.5 ( / ) ) )) vừa dẫn động vừa rẽ hướng, bánh cao su phía sau bánh Từ thông tin thu thập trên, để lựa chọn mơ hình kết cấu phù hợp cần phải thực q trình phân tích, so sánh ưu, nhược điểm phần quan trọng kết cấu xe So sánh ưu, nhược điểm a Về kết cấu  Xe bánh Mơ hình Bám đường Vào cua Điều khiển Kết cấu Mơ hình VS Nhóm Đồ án TKHT Cơ-Điện Tử Bám đường Vào cua Điều khiển Kết cấu  Xe bánh Mô hình Bám đường Vào cua Điều khiển Kết cấu b Về số lượng bánh xe Số bánh Đồng phẳng Độ ổn định có vật cản Lật vào cua Ma sát Về Điện Về cảm biến Phần lớn robot dò line sử dụng loại cảm biến quang để nhận biết vị trí tương đối đường line so với xe, từ xử lí để đưa tín hiệu điều khiển Có hai phương pháp thường sử dụng cho robot dò line phương pháp sử dụng camera loại cảm biến quang dẫn:  Trường hợp sử dụng camera để phát vị trí line người ta sử dụng hình ảnh thu [5] tử đường line thực tế , sau xử lý dùng giải thuật xử lý ảnh để xác định vị trí góc lệch xe so với đường line Các xe sử dụng camera Smart Car thi The Freescale 2012 hay Raspberry Pi Line Following Robot thi Robocup Junior Competition Flanders 2014…  Trường hợp sử dụng cảm biến quang dẫn sử dụng phổ biến thi robot dị line Điển quang điện trở phototransistor kết hợp với LED Hai loại cảm biến có nguyên tắc hoạt động giống nhau, thu thu tín hiệu ánh sáng phản xạ từ phát xuống mặt đất, từ xử lí để xác định vị trí đường line Các xe sử dụng phototransistor cho phận dò line Usain Volt 2.0, Thunderbolt… Nhóm Đồ án TKHT Cơ-Điện Tử Bảng so sánh loại cảm biến Cảm biến Thời gian xử lý Giá thành Lắp đặt Có cách đọc giá trị áp phận thu cảm biến trả về:  Cách thứ đọc theo dạng analog với sơ đồ điện cảm biến hình H Tín hiệu analog đọc [6] từ cảm biến qua phép xấp xỉ để tìm vị xe so với tâm đường line Các giải thuật xấp xỉ theo bậc 2, theo trọng số (hình H ) cho sai số dị line khác H Sơ đồ điện đọc giá trí analog cảm biến hồng ngoại (a) (b) H (a) Xấp xỉ bậc 2; (b) Xấp xỉ theo trọng số  Cách thứ hai đọc digital Tín hiệu đầu cảm biến anlog sau thông qua mạch lấy ngưỡng, lấy ngưỡng lập trình giá trị logic ứng với vị trí cảm biến đường line đường line Sơ đồ mạch đọc giá trị cảm biến phương pháp hình H H Sơ đồ điện cảm biến để đọc giá trị digital Nhóm Đồ án TKHT Cơ-Điện Tử Xe Đua Dò Line Để điều khiển robot theo quỹ đạo, người thiết kế lập trình xác định độ lệch tương đối quỹ đạo robot quỹ đạo mong muốn, sau so sánh độ lệch thành mức điều khiển lái robot quay quỹ đạo hình H [7] Trạng thái cảm biến Giữa vạch Lệch trái mức ` Lệch trái mức Lệch phải mức Lệch phải mức H Quy định mức lệnh quy đạo robot quỹ đạo mong muốn Bảng so sánh phương pháp đọc cảm biến Độ xác Thời gian đọc tín hiệu Giải thuật xử lý Về động Hầu hết xe dò line thực tế dùng động dc có gắn encoder, có Encoder hồi tiếp nên đảm bảo độ ổn định xác cho hệ thống Đối với xe việc chuyển hướng không dùng bánh đa hướng dùng Rc Servo để điều khiển hướng di chuyển Các xe Usain Volt 2.0 sử dụng động 50:1 HP gearmotors , Silvestre-line sử dụng động Maxon DC motor Bảng so sánh động servo DC Điều khiển Giá thành Về Cấu Trúc Điều Khiển Mạch xe dò line gồm thành phần gồm mạch cảm biến (sensor); mạch điều khiển (micro controller); mạch lái động (driver) Có hai phương pháp để kết nối phần cứng với điều khiển tập trung điều khiển phân cấp  Trong điều khiển tâp trung, MCU đồng thời: nhận xử lý tín hiệu từ cảm biến, nhận xử lý tín hiệu từ hai encoder, thực chương trình chính, tính giá trị điều khiển truyền cho hai động Cấu trúc sử dụng nhiều thực tế hầu hết mơ hình xe: HBFS, Pika,… Nhóm Đồ án TKHT Cơ-Điện Tử  Trên sa bàn có vị trí đặc biệt nút giao số vị trí cua 900 Xe Đua Dị Line  Nút giao số 8: vị trí cảm biến dễ bị nhiễu làm xe bám sai line.Nhóm xử lý cách cho vận tốc bánh xe vào line thẳng thời gian ngắn để vượt qua nút giao, sau cho xe tiếp tục bám line bình thường  Cua 900: Do biết trước vận tốc sa bàn nên nhóm sử dụng timer đo thời gian xe chạy tới vị trí cho vận tốc bánh trái = 0, vận tốc bánh phải = 200 Dừng H Nhóm Lưu đồ giải thuật Slaver 38 Đồ án TKHT Cơ-Điện Tử Xe Đua Dị Line Mơ Hình Hóa Mơ hình hóa động học H Mô tả biểu diễn động học xe Vận tốc xe chạy vị trí tâm bánh xe dẫn động ̇=× = ̇ × = ̇ (7) =>[ ]=[ Quan hệ động học bánh xe (8) = với : vận tốc bánh trái : vận tốc bánh phải : khoảng cách bánh xe Phương trình động học điểm bám line C xe = ̇ × = ̇ = ̇ ̇ − × × + × với khoảng cách từ tâm bánh xe đến vị trí bám line Xét vị trí đường line điểm R (9) ̇ = ̇ = (10) { ̇ = với vận tốc yêu cầu đường line Ta có sai số động học: { =( − ) 2=−( 3= +( − − ) ) +( − ) − Đạo hàm sai số động học, ta được: [ 2] ̇ =[3]+[ (11) (12) Trong trường hợp xe chuyển động ngược, công thức thay − , dương hay âm phụ thuộc hướng chuyển động xe Nhóm 39 Đồ án TKHT Cơ-Điện Tử Xe Đua Dò Line Thiết kế điều khiển Định lí : Hệ thống (12) ổn định với độ điều khiển bám line sau: = cos + (13) 11 { Ta chọn hàm Lyapunov: (14) = Với hệ số k1, k2, k3 giá trị dương Ta đạo hàm được: ̇ ̇ = ( Chúng ta cần điều khiển (15) ̇đạt giá trị âm Có nghĩa ta phải điều khiển để giá trị sai số tiến thời gian tiến ∞ Mơ hình hóa cảm biến Số lượng cảm biến chọn cảm biến ( lập luận dựa phần mô khoảng cách mà hai sensor không bị nhiễu khoảng cách tối thiểu hai sensor ngồi để xe dị line hết đường đua) Khoảng cách cảm biến 13 ( Tọa độ cảm biến = trùng với tâm sensor ) Chính khoảng cách để cách sensor không bị nhiễu giá trị đọc tốt (thực nghiệm) { = Gọi , tọa độ chung, e khoảng cách cảm biến 0, 1, 2, 3, 4, 5, 6, Độ lớn e khoảng cách nhỏ mà cảm biến khơng bị nhiễu Theo tính tốn phần mô phỏng, để đáp ứng được, tức bám line tốt, khoảng cách hai cảm biến phải đạt khoảng cách d Ta giả sử, vị trí tâm hai bánh xe : C( ⇒⇒⇒ =( − , − )( − )+( − ) Tâm sensor S( , ) ) Phương trình qua sensor ( − , )( − )=0 Từ ta dễ dàng xác định vị trí tọa độ sensor có tọa độ sensor trung tâm Cách tìm sai số Để xe bám theo line, công việc xác định vị trí xe so với line Ta đặt hệ toạ độ H.43, M trung điểm bánh xe, C trung điểm dãy sensor Nhóm 40 Đồ án TKHT Cơ-Điện Tử Xe Đua Dị Line Mục đích giải thuật điều khiển làm cho điểm C bám theo điểm tham chiếu R Để làm điều đó, ta cần xác định sai số lớn Vì cho sai số = H Trên thực tế, sai số 2 Do ta sử dụng cảm biến nên cơng thức tính sai số Cách tính sai số dựa làm cho sai số đo từ dãy sensor Từ phương trình hàm xấp xỉ bậc vị trí thực cảm biến giá trị analog thu được: = 0.9629 − 1.4789 với y: giá trị đọc cảm biến x: vị trí tâm cảm biến so với tâm line sai số lớn Ta có cách tính sai số = 2.78 ( từ 2= ) phương trình cảm biến cho mơ hình hóa: 0.9629 − 1.4789 + [− ; ] Mơ hình hóa động Từ hàm truyền hai động dụng = = 318 + 0.055 351 + 0.061 Và hệ số = 0.05, hai động sau sử = = 0.318 = 2.88, = 0.001, ta tìm hàm truyền vịng kín điều khiển PID + 15.9 + 915.8 0.351 + 17.55 + 1011 Biến đổi Laplace ngược, ta hàm truyền vịng kín hai động miền thời gian _1 Nhóm =1− 1055 373 [1.12 −22.65 sin(44.068 − 1.07)] 41 Đồ án TKHT Cơ-Điện Tử _2 = − 1061 412 [1.12 Xe Đua Dị Line −22.512 sin(44.13 − 1.1)] Kết mơ Bảng thông số xe thông số điều khiển: Thông số Khoảng cách từ tâm tracking đến tâm sensor Khoảng cách hai bánh xe Thời gian lấy mẫu Vận tốc tham chiếu xe ( ) Đoạn (A-B-C-D-E) x( ) H Bám line đoạn Nhóm 42 Nhóm 43 Đồ án TKHT Cơ-Điện Tử Xe Đua Dò Line ( ) Đoạn (E-F-C-G-A-C-E) 350 300 250 200 150 100 50 -50 -100 -150 Nhóm 44 Đồ án TKHT Cơ-Điện Tử   Sai số lớn 13.5 ( Sai số lớn 21 ( ), vận tốc bánh xe tối đa 270.6 ( ), vận tốc bánh xe tối đa 300 ( Xe Đua Dò Line ) đoạn ) đoạn  Như vậy, sai số nằm khoảng cho phép ( 39 ( Nhóm )), động đáp ứng vận tốc bánh xe yêu cầu (lớn 320 ( )) 45 Đồ án TKHT Cơ-Điện Tử Xe Đua Dò Line CHƯƠNG 4: KẾT QUẢ THỰC NGHIỆM Kết Quả Thực Nghiệm Nhóm hồn thành việc chế tạo mơ hình, vận hành thực tế để kiểm nghiệm giải thuật Tuy robot hoàn thành việc bám hết sa bàn với thời gian 34s cách ổn định,nhưng vận tốc xe không cao (0.4 ( / )), sai số bám line lớn, đặc biệt vị trí vào cua: (a) (b) H.53 Xe chạy qua điểm F sa bàn thực nghiệm (a) (b) Xe bắt đầu bẻ cua Xe bẻ cua, vào trạng thái ổn định (a) H.54 Xe chạy qua điểm G sa bàn thực nghiệm (a) (b) Nhóm Xe bắt đầu bẻ cua Xe bẻ cua, vào trạng thái ổn định 46 Đồ án TKHT Cơ-Điện Tử (a) Xe Đua Dò Line (b) (c) H.55 Xe vào cua điểm A sa bàn thực nghiệm (a) Xe bắt đầu bẻ cua (b) Xe bẻ cua, chưa ổn định (c) Xe bắt line (d) Xe vào trạng thái ổn định Nhận xét: Ta nhận thấy robot chuyển hướng, sai số bám line cảm biến đọc lớn, xe phải cần khoảng thời gian để đáp ứng ổn định Sự ổn định xe đoạn sau phụ thuộc vào ổn định đoạn trước, vận tốc xe số Kết luận: Xe bám line ổn định theo giải thuật chưa đáp ứng sai số vận tốc đặt Sai số vượt qua sai số mô phỏng, vận tốc thấp vận tốc mơ 1, Nhóm 2, 47 Đồ án TKHT Cơ-Điện Tử Xe Đua Dị Line Phân Tích Thực Nghiệm  Trong mô phỏng, bỏ qua yếu tố ảnh hưởng:  Khối lượng lực quán tính thành phần xe  Các lực ma sát bánh xe sa bàn  Sai số đồng trục hai bánh xe  Thời gian đáp ứng động  Các tác động nhiễu môi trường độ đồng ánh sáng, màu sắc độ phẳng sa bàn  Do đó, kết thực nghiệm khơng khớp với mơ  Bên cạnh đó, thiết kế cảm biến, kiểm tra cảm biến sa bàn khác với sa bàn thực nghiệm, dẫn đến việc calib cảm biến bị sai lệch; chưa che chắn cảm biến đầy đủ; thiếu cảm biến nhận dạng chỗ giao nhau, đoạn chuyển tiếp Đề Xuất Hiệu Chỉnh Thiết Kế  Gia công thân xe gá trục động lại vật liệu nhôm để đảm bảo độ đồng tâm bánh xe tốt  Động vấn đề quan tâm, cần lựa chọn tính tốn xác để khơng đáp ứng đủ moment, mà thời gian đáp ứng vận tốc động cần vượt mức yêu cầu  Thiết kế phận che cảm biến tốt hơn; thêm cảm biến để nhận biết chỗ giao đoạn chuyển tiếp Nhóm 48 Đồ án TKHT Cơ-Điện Tử Xe Đua Dò Line CHƯƠNG 5: BIỂU ĐỒ GANLT I TỔNG QUAN Tìm hiểu vấn đề liên quan viết tổng quan Đề xuất lựa chọn phương án phù hợp Hiệu chỉnh phần tổng quan II THIẾT KẾ Cơ khí Tính tốn lựa chọn động Vẽ phác thảo, vẽ 3D hiệu chỉnh Vẽ vẽ 2D Hiệu chỉnh thông số Điện Xây dựng sơ đồ khối nguyên lý hệ thống điện Lựa chọn thành phần hệ thống điện Xây dựng mạch điều khiển mạch công suất Hiệu chỉnh Điều khiển động Hardware - sofware Xây dựng sơ đồ khối cho hệ thống điều khiển Lựa chọn vi điều khiển xây dựng lưu đồ giải thuật Lập trình cho vi điều khiển Hiệu chỉnh thông số Bộ điều khiển Mơ hình hóa xe đua bám line Hiệu chỉnh III Hoàn thành tài liệu kỹ thuật xe đua bám line 1011121314151617 H.50 Biểu đồ ganlt tiến độ công việc dự kiến I TỔNG QUAN Tìm hiểu vấn đề liên quan viết tổng quan Đề xuất lựa chọn phương án phù hợp Hiệu chỉnh phần tổng quan II THIẾT KẾ Cơ khí Tính tốn lựa chọn động Vẽ phác thảo, vẽ 3D hiệu chỉnh Vẽ vẽ 2D Hiệu chỉnh thông số Điện Xây dựng sơ đồ khối nguyên lý hệ thống điện Lựa chọn thành phần hệ thống điện Xây dựng mạch điều khiển mạch công suất Hiệu chỉnh Điều khiển động Hardware - sofware Xây dựng sơ đồ khối cho hệ thống điều khiển Lựa chọn vi điều khiển xây dựng lưu đồ giải thuật Lập trình cho vi điều khiển Hiệu chỉnh thơng số Bộ điều khiển Mơ hình hóa xe đua bám line Hiệu chỉnh III Hoàn thành tài liệu kỹ thuật xe đua bám line 1011121314151617 H.51 Biểu đồ ganlt tiến độ cơng việc thực tế Nhóm 49 I TỔNG QUAN Tìm hiểu vấn đề liên quan viết tổng quan Đề xuất lựa chọn phương án phù hợp Hiệu chỉnh phần tổng quan II THIẾT KẾ Cơ khí Tính tốn lựa chọn động Vẽ phác thảo, vẽ 3D hiệu chỉnh Vẽ vẽ 2D Hiệu chỉnh thông số Điện Xây dựng sơ đồ khối nguyên lý hệ thống điện Lựa chọn thành phần hệ thống điện Xây dựng mạch điều khiển mạch công suất Hiệu chỉnh Điều khiển động Hardware - sofware Xây dựng sơ đồ khối cho hệ thống điều khiển Lựa chọn vi điều khiển xây dựng lưu đồ giải thuật Lập trình cho vi điều khiển Hiệu chỉnh thông số Bộ điều khiển Mô hình hóa xe đua bám line Hiệu chỉnh III Hồn thành tài liệu kỹ thuật xe đua bám line H.52 Biểu đồ ganlt tiến độ công việc tốt thực đồ án Nhóm 50 Đồ án TKHT Cơ-Điện Tử Xe Đua Dò Line TÀI LIỆU THAM KHẢO [1] Vehicle Dynamics: Theory and Applications, Reza N Jazar, Springer, p.50 – p.70 nd [2] Tính Tốn TKHT Dẫn Động Cơ Khí Tập (12 ), Trịnh Chất, NXBGDVN, p.5 – p.13 nd [3] Tính Tốn TKHT Dẫn Động Cơ Khí Tập (12 ), Trịnh Chất, NXBGDVN, p.116 – p.142 nd [4] Dung Sai Lắp Ghép (12 ), Ninh Đức Tốn, NXBGDVN, p.70 – p.77, p.107 – p.125 [5] Jean-Francois Dupuis and Marc Parizeau, Evolving a Vision-Based LineFollowing Robot Controller, p.1-p.2 [6] Juing-Huei Su et al., An intelligent line-following robot project for introductory robot courses, World Transactions on Engineering and Technology Education,Vol.8, No.4, p.455-461, 2010 [7] Trần Đức Quân, Điều khiển robot dò đường theo vạch với điều khiển Pid [8] Vishay Semiconductors - Datasheet TCRT5000 [9] Huong dan su dung chuong trinh BKIT MCR.pdf [10] M S Islam and M A Rahman, Design and Fabrication of Line Follower Robot, Asian Journal of Applied Science and Engineering, 2013 [11] Vikram Balajia et al., Optimization of PID Control for High Speed Line Tracking Robots, in 2015 IEEE International Symposium on Robotics and Intelligent Sensors, 2015 [12] Umar Farooq et al., Fuzzy Logic Reasoning System for Line Following Robot, IACSIT International Journal of Engineering and Technology, 2014 [13] Đường Khánh Sơn & Từ Diệp Công Thành, Ứng Dụng Bộ Điều Khiển Self Tuning Fuzzy-Pi Điều Khiển Omni-Directional Mobile Robot, Báo Khoa học & Ứng dụng, Số 20, pp.54-57, 2012 [14] Huu Danh Lam et al., Smooth tracking controller for AGV through junction using CMU camera, Tuyển tập HN Cơ điện tử lần 7, VCM-2014, pp.597-601, Vietnam, 2014 [15] Fernando Orduña C et.al., ALDRO Learning and Mixed Decision Support Method for Mobile Robot, Workshop Proceedings of the 8th International Conference on Intelligent Environments, J.A Botía et al (Eds.), IOS Press, 2012 Nhóm 51 ... chuyển robot MỤC TIÊU Do yêu cầu ĐAMH thiết kế, chế tạo điều khiển robot xe đua dò line nên mục tiêu quan trọng trình xe đua dị line chạy nhanh Nhóm 1 Đồ án TKHT Cơ- Điện Tử Xe Đua Dị Line CHƯƠNG... Nhóm Đồ án TKHT Cơ- Điện Tử Bám đường Vào cua Điều khiển Kết cấu  Xe bánh Mơ hình Bám đường Vào cua Điều khiển Kết cấu b Về số lượng bánh xe Số bánh Đồng phẳng Độ ổn định có vật cản Lật vào cua... ℎ) Từ thiết kế, lựa chọn phần tử điện, ta có sơ đồ khối chung cho tồn hệ thống: CB Master Slave Dc Motor Encoder H Sơ đồ khơi chung cho tồn hệ thống Nhóm 30 Đồ án TKHT Cơ- Điện Tử Xe Đua Dò Line