Thiết kế, chế tạo và điều khiển robot dò line (line following robot)

ĐẠ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Ử GVHD: TS Phùng Trí Cơng Sinh viên thực hiện: MSSV Hà Nguyễn Thuận Tâm 1413409 Nguyễn Phong Hậu 1411138 Lê Ngọc Ân 1410163 Võ Công Nguyên 1412579 TpHCM, ngày 21 tháng 10 năm 2017 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ GVHD: TS PHÙNG TRÍ CƠNG MỤC LỤC MỤC LỤC i DANH SÁCH HÌNH ẢNH iii DANH SÁCH BẢNG BIỂU v MỤC TIÊU ĐỒ ÁN CHƯƠNG 1: TỔNG QUAN CHƯƠNG 2: ĐỀ XUẤT VÀ LỰA CHỌN PHƯƠNG ÁN 2.1 Đề xuất sơ đồ nguyên lý 2.2 Đề xuất cảm biến 2.3 Đề xuất cấu trúc điều khiển 2.4 Đề xuất giải thuật điều khiển 2.5 Phương án thiết kế CHƯƠNG 3: MECHANICAL SYSTEMS 10 3.1 Lựa chọn bánh xe 10 3.2 Lựa chọn động 10 3.3 Kích thước thân xe 12 3.4 Thiết kế đồ gá cho động 13 CHƯƠNG 4: INFORMATION SYSTEMS 16 4.1 Mơ hình động học robot 16 4.2 Cách xác định vị trí robot 17 4.3 Bộ điều khiển tracking, tìm khoảng cách d mơ bám sa bàn .19 CHƯƠNG 5: ELECTRICAL SYSTEMS 25 5.1 Hệ thống cảm biến 25 5.1.1 Xác định yêu cầu cảm biến 25 5.1.2 Thực nghiệm cảm biến 25 5.2 Hệ thống điều khiển động 29 5.2.1 Lựa chọn driver 29 5.2.2 Mơ hình hóa hệ driver-động 29 5.2.3 Bộ điều khiển PID 33 ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ 5.3 GVHD: TS PHÙNG TRÍ CƠNG Lựa chọn pin 36 CHƯƠNG 6: COMPUTER SYSTEMS 37 6.1 Lựa chọn vi điều khiển 37 6.1.1 Sơ đồ khối điều khiển 37 6.1.2 Xác định yêu cầu lựa chọn vi điều khiển 37 6.1.3 Lựa chọn vi điều khiển 38 6.2 Tính tốn thời gian truyền nhận liệu 38 6.3 Giải thuật điều khiển 39 CHƯƠNG 7: KẾT QUẢ THỰC NGHIỆM 40 PHỤ LỤC A: KIT THÍ NGHIỆM SENSOR 42 PHỤ LỤC B: TÀI LIỆU THAM KHẢO 44 DANH SÁCH HÌNH ẢNH Hình 0.1 Sa bàn di chuyển robot Hình 1.1 Sơ đồ nguyên lý RC racing cars Hình 1.2 Sơ đồ nguyên lý hai cặp chủ động vi sai (a) Loại bánh; (b) Loại bánh Hình 1.3 Giải thuật xử lí tín hiệu phương pháp so sánh [18] Hình 1.4 Giải thuật xử lý tín hiệu cảm biến phương pháp xấp xỉ Hình 2.1 Phương án sơ đồ nguyên lý Hình 2.2 Phương án cấu trúc điều khiển Hình 3.1 Mơ hình toán bánh xe 10 Hình 3.2 Mơ hình toán xe chuyển hướng 12 Hình 3.3 Sơ đồ xếp linh kiện thân xe 14 Hình 4.1 Mơ hình động học mobile platform 16 Hình 4.2 Mơ hình động học sử dụng cho robot dò line 18 Hình 4.3 Cách xác định e3 18 Hình 4.4 Sai số trung bình ứng với giá trị khoảng cách d 19 Hình 4.5 Kết bám line đoạn A-B-C-D 21 Hình 4.6 Kết bám line đoạn D-E-F-C-G 22 Hình 4.7 Kết bám line đoạn G-A-C-E 23 Hình 4.8 Robot phát tự động thực đổi hướng đoạn vuông góc 24 Hình 4.9 Robot phát đoạn giao cắt 24 Hình 5.1 Sơ đồ khối hệ thống điện 25 Hình 5.2 Sơ đồ mạch điện cảm biến TCRT5000 cho thí nghiệm 26 Hình 5.3 Phạm vi hoạt động cảm biến dựa theo góc chiếu 27 Hình 5.4 Đồ thị kết thí nghiệm đo giá trị điện áp trả từ cảm biến 27 Hình 5.5 Mơ hình vùng giao thoa cực phát cực thu 28 Hình 5.6 Đường đặc tuyến giá trị đọc từ cảm biến giá trị lý tưởng 29 Hình 5.7 Đồ thị PWM(%) vận tốc quay động 30 Hình 5.8 Đồ thị đáp ứng theo thời gian khối driver-động 31 Hình 5.9 Đồ thị PWM(%) vận tốc quay động 32 Hình 5.10 Đồ thị đáp ứng theo thời gian khối driver-động 33 Hình 5.11 Mô đáp ứng khối driver-động sau thêm PID .34 Hình 5.12 Đồ thị đáp ứng theo thời gian khối driver-động sau thêm PID 34 Hình 5.13 Mơ đáp ứng khối driver-động sau thêm PID .35 Hình 5.14 Đồ thị đáp ứng theo thời gian khối driver-động sau thêm PID 35 Hình 6.1 Sơ đồ khối điều khiển 37 Hình 6.2 Chu kỳ truyền nhận liệu hệ thống 38 Hình 6.3 Lưu đồ giải thuật hệ thống 39 Hình 7.1 Kết chạy mơ 40 Hình 7.2 Kết chạy thực tế 41 Hình A.1 Mơ hình thí nghiệm dùng cho thí nghiệm 42 Hình A.2 Bộ mơ hình dùng cho thí nghiệm 43 DANH SÁCH BẢNG BIỂU Bảng 3.1 Thông số đầu vào xe 11 Bảng 3.2 Thông số yêu cầu động 12 Bảng 3.3 Các thiết bị thân xe 13 Bảng 4.1 Thông số đầu vào mô 19 Bảng 4.2 Thông số đầu vào mô 20 Bảng 5.1 Số liệu thử nghiệm TB6612 với động 30 Bảng 5.2 Số liệu thử nghiệm TB6612 với động 32 Bảng 5.3 Dòng điện tiêu thụ linh kiện mạch 36 MỤC TIÊU ĐỒ ÁN Thiết kế chế tạo xe dò line di chuyển tốc độ cao sa bàn có đặc điểm : - Màu sắc đường line: Đen - Màu nền: Trắng - Bề rộng đường line: 26mm - Bề mặt địa hình di chuyển: Mặt phẳng - Bán kính cong lớn nhất: 500mm - Sa bàn thể Hình 0.1 F END B A START R500 C E R500 1500 D G 3000 Hình 0.1 Sa bàn di chuyển robot - Yêu cầu: Khi bắt đầu, robot đặt vị trí START (điểm A), sau robot chạy theo thứ tự qua điểm nút quy định : (START) A → B → C → D → E → F → C → G → A → C → E (END) - Tốc độ di chuyển tối thiểu robot 0.2 m/s - Mỗi robot mang vật nặng có trọng lượng kg với kích thước tối đa tải trọng (dài x rộng x cao): 200mm x 100mm x 300mm CHƯƠNG 1: TỔNG QUAN Sơ lược Robot dò line: Robot dò line (Line Following Robot) dạng robot di động (mobile robot) di chuyển bánh xe Robot di chuyển bám theo đường line làm sẵn mặt đất Quỹ đạo robot phụ thuộc vào sa bàn hệ thống đường line có sẵn Trong đồ án thiết kế điều khiển xe đua bám đường theo quỹ đạo cho trước Mục đích xe đua di chuyển quãng đường với thời gian ngắn nhất, đảm bảo theo yêu cầu bám line đặt Sơ đồ nguyên lý: Rất nhiều sơ đồ nguyên lý ứng dụng cho việc chế tạo robot dò line Để đạt tốc độ khả bám đường, sơ đồ nguyên lý loại xe đua điều khiển từ xa (RC racing cars) sử dụng Có hai loại sơ đồ nguyên lý chung cho loại xe đua chuyên chạy mặt đường phẳng: - Loại 1(Hình 1.1a) sử dụng trục truyền động cho trục trước sau xe (Khung xe hãng Awesomatrix, TAMIYA TT01, Overdose Divall…) Loại 2(Hình 1.1b) sử dụng đai truyền động cho trục trước sau xe (Khung xe hãng Sakura D3 CS, Serpent VETEQ 02, TA04 EPRO…) Những sơ đồ nguyên lý có đặc điểm hạn chế tượng trượt bánh xe thực đổi hướng, nhiên thiết kế khí phức tạp bán kính cong nhỏ xe bị giới hạn kết cấu xe XX XX XX (a) (b) Hình 1.1 Sơ đồ nguyên lý RC racing cars (a) loại truyền động trục; (b) loại truyền động đai Đáp ứng thực tế khối sau thêm PID - Settling time: Ts = 0.017s - Steady state error: ess = 5% Overshoot: M = 6% 5.3 Lựa chọn pin: Sa bàn thi bao gồm đoạn đường: đường thẳng dài 3000mm, đoạn đường cong bán kính 500mm đoạn đường giao dài 1118mm Tổng chiều dài đoạn đường S = 10613 mm Vận tốc xe trung bình 1.3 m/s, thời gian cần để chạy hết đoạn đường t = 10.613/1.3 = 8.16 s Để đảm bảo trình thử nghiệm, pin yêu cầu phải có dung lượng đủ lớn để xe thử nghiệm nhiều lần Yêu cầu kĩ thuật: - Áp pin phải lớn áp lớn thiết bị hệ thống (động ESCAP 16G88-214EMR19 8V) - Khả cung cấp dòng cho hệ thống hoạt động khoảng Tính tốn cường độ dòng điện cần cung cấp: Bảng 5.3 Dòng điện tiêu thụ linh kiện mạch Thiết bị Số lượng Dòng/1 đơn vị Tổng cộng Áp cung cấp Động 650mA 1300mA 12VDC Encoder 6mA 12mA 5VDC Cảm biến 38mA 266mA 5VDC Vi điều khiển Tổng cộng 30mA 120mA 1698 x 1.3=2207 mA 5VDC Từ yêu cầu kĩ thuật nguồn điện cần cung cấp, mắc nối tiếp cục pin Lion 4.2V 4200mAh CHƯƠNG 6: COMPUTER SYSTEMS Chương bao gồm lựa chọn loại vi điều khiển, thời điểm truyền nhận lưu đồ giải thuật vi điều khiển 6.1 Lựa chọn vi điều khiển: 6.1.1 Sơ đồ khối điều khiển Sensor Slave Driver Slave Master Slave Driver Động Động Encoder Encoder Hình 6.1 Sơ đồ khối điều khiển Robot sử dụng giải thuật điều khiển phân cấp sử dụng vi điều khiển đảm nhận chức riêng biệt Trong có: - slave có nhiệm vụ đọc xử lí tín hiệu sensor slave có nhiệm vụ điều khiển động thông qua driver encoder master làm điều khiển trung tâm, có nhiệm vụ thu thập liệu từ slave đọc cảm biến, sau tiến hành tính tốn lệnh cho slave điều khiển động đưa robot di chuyển theo quỹ đạo 6.1.2 Xác định yêu cầu lựa chọn vi điều khiển: Dựa phương án thiết kế lựa chọn cho Robot, vi điều khiển sử dụng làm xử lí trung tâm, có nhiệm vụ thu thập tín hiệu từ cảm biến, sau tiến hành tính tốn, điều chỉnh truyền tín hiệu đến động Hiện thị trường có nhiều dịng vi điều khiển, dịng có đặc tính khả khác Tuy nhiên, ta cần lựa chọn dịng vi điều khiển thích hợp để đảm bảo đáp ứng yêu cầu đặt cho Robot, cụ thể: - Robot sử dụng động để di chuyển, vậy, Slave điều khiển động cần có điều xung PWM Số lượng cảm biến tối thiểu lựa chọn nên slave đọc cảm biến cần có ngõ vào Analog Có ngắt để đọc tín hiệu Encoder Bộ điều khiển phân cấp nên phải có hỗ trợ giao tiếp SPI, I2C RS232… - 6.1.3 Lựa chọn vi điều khiển: Từ yêu cầu trên, có loại vi điều khiển lựa chọn: Đối với slave đọc cảm biến, vi điều khiển Pic 16f887 hãng Microchip lựa có đặc điểm phù hợp: - Có 14 ngõ vào Analog Hỗ trợ giao tiếp SPI, I2C, RS232 Đối với slave điều khiển động master, vi điều khiển ATmega368 hãng Atmel, tích hợp kit phát triển Adruino Nano lựa chọn có đặc điểm: - Có ngắt Tần số xung clock 16Mhz cho thời gian chu kì lệnh nhanh (62,5ns) thời gian đọc xung encoder ngắt ngồi nên khơng có tượng trượt xung đọc Hỗ trợ giao tiếp SPI, I2C RS232 6.2 Tính tốn thời gian truyền nhận liệu: Slave Slave sensor sensor đọc đọc tính sai tính sai Slave số số sensor 7ms 7ms Ma ster Gửi tín hiệu yêu cầu slave sensor gửi sai số lần Gửi tín Tính hiệu yêu tốn cầu slave gửi tín sensor hiệu vận gửi sai tốc cho số lần slave động Slave sensor đọc tính sai số Slave sensor đọc tính sai số 7ms Chờ thời gian đáp ứng động Gửi tín hiệu yêu cầu slave sensor gửi sai số lần 7ms 8ms 8ms 4ms 40ms 8ms Hình 6.2 Chu kỳ truyền nhận liệu hệ thống Trong trình truyền nhận liệu, Master chủ động lấy sai số từ Slave sensor Slave sensor đọc liên tục tín hiệu thu tính tốn giá trị error Khi có tín hiệu u cầu, Slave sensor gửi cho Master Master nhận tính giá trị vận tốc tương ứng để truyền cho Slave điều khiển động Sau thời gian đáp ứng động cơ, Master tiếp tục gửi yêu cầu cho Slave sensor gửi giái trị sai số chu kì lặp lại 6.3 Giải thuật điều khiển Start Cài đặt thông số k ứng với thẳng F - G Cài đặt số k ứng với đoạn cong A - B S S Gặp điểm B Gặp điểm G Đ Đ Cài đặt thông số k ứng với đoạn cong G - A Cài đặt số k ứng với đoạn thẳng B - D S Gặp điểm DGặp điểm A S Đ Cài đặt thông số k ứng với đoạn cong D - F Gặp điểm F Đ Robot quay 90 độ Cài đặt thông số k ứng với đoạn thẳng A - E S Gặp điểm E Đ Dừng xe Kết thúc Hình 6.3 Lưu đồ giải thuật hệ thống CHƯƠNG 7: KẾT QUẢ THỰC NGHIỆM Chương đánh giá kết thực nghiệm mơ hình so với mơ đưa kết luận Kết chạy mô thực tế của xe theo vR = 1.3m/s đường line thể Hình 7.1, Hình 7.2 Hai hình thể dạng bám line xe giống nhau: đoạn đường thẳng (B→D, F→G, A→E), xe thể dao động hai bên đường line; đoạn đường cong (A→B, D→F, G→A), xe nằm bên so với đường line Trong sai số mô đạt yêu cầu đề sai số (trên đường thẳng cong: emax = ±16mm đoạn đổi hướng: emax = 250mm, thể Hình 4.5b, Hình 4.6b, Hình 4.7b), sai số thực tế xe lại không thỏa yêu cầu đề sai số đoạn thẳng cong Các lý dẫn đến việc tăng sai số bao gồm: - Sai số lắp đặt khiến độ đồng trục hai động n kSai số tốc độ hai động Hình 7.1 Kết chạy mơ 43 Hình 7.2 Kết chạy thực tế - Sai số hệ thống cảm biến cảm biến khác biệt mơi trường thí nghiệm thực nghiệm Sai số hệ thống cảm biến chiều cao gá đặt độ song song với trục động Để khắc phục sai số này, giải pháp đề bao gồm: - Khung xe đồ gá chế tạo nhôm, thay cho mica mơ hình thực nghiệm, để kiểm sốt sai số q trình gia cơng lắp đặt Thực thí nghiệm nhằm đánh giá sai số vận tốc động để đưa vào mơ 41 - Thực nghiệm thí nghiệm để đánh giá ảnh hưởng môi trường thực nghiệm lên giá trị đọc hệ thống cảm biến để thực biện pháp xử lý phù hợp 42 PHỤ LỤC A: KIT THÍ NGHIỆM SENSOR Để phân tích lựa chọn thơng số cho việc thiết kế cảm biến, mơ hình thí nghiệm sử dụng 1/ Bộ thí nghiệm xác định khoảng cách phù hợp cảm biến mặt đường, khoảng cách cảm biến với Hình A.1 Mơ hình thí nghiệm dùng cho thí nghiệm Mơ hình bao gồm đế lớn mạch cảm biến rời Mỗi mạch cảm biến rời có chân cắm cấp nguồn 5V, chân GND chân để lấy tín hiệu analog trả từ cảm biến Tấm đế thay đổi chiều cao tùy ý để xác định khoảng cách phù hợp cảm biến với mặt đường Ngoài ra, đế thiết kế có rãnh trượt để dễ dàng thay đổi khoảng cách cảm biến Kết thí nghiệm mơ tả Hình 5.4 2/ Bộ thí nghiệm xác định phương trình tuyến tính lý tưởng tín hiệu cảm biến Mơ hình sử dụng cho thí nghiệm 3, nhằm mục đích kiểm tra đánh giá cách tương đối khả đáp ứng cảm biến điều kiện thực tế Mơ hình gồm ray trượt có cố định đoạn đường line thẳng mặt kéo dịch chuyển qua lại động bước kết hợp với hệ thống dây đai Bộ cảm biến cố định theo khoảng cách lựa chọn thí nghiệm Dữ liệu đo từ cảm biến vi điều khiển đọc, xử lí tính tốn, sau truyền tới máy tính chuẩn truyền RS232, phần mềm Matlab thu thập liệu xuất đồ thị đáp ứng tín hiệu trả (giữa vị trí thực tế vị trí tính tốn) Từ tìm phương trình tuyến tính xấp xỉ mong muốn 43 Hình A.2 Bộ mơ hình dùng cho thí nghiệm Kết thí nghiệm mơ tả Hình 5.6 44 PHỤ LỤC B: TÀI LIỆU THAM KHẢO [1] DAIFUKU, SMARTCART, Automatic Guided Cart Installed Systems [2] Richard T Vannoy II, M.S.I.T., B.S.E.E.T Designing and Building a Line Following Robot [3] Andrew Reed Bacha, Line Detection and Lane Following for an Autonomous Mobile Robot, MS diss., Virginia Polytechnic Institute and State University, 2005 [4] Ramiro Velázquez et al., A Review of Models and Structures for Wheeled Mobile th Robots: Four Case Studies, The 15 International Conference on Advanced Robotics, Estonia, June 20-23, 2011 [5] Bruno Siciliano & Oussama Khatib, chapter 17.2.2-17.2.6, Springer handbook of robotics Germany: Springer-Verlag Berlin Heidelberg, 2008 [6] G H Lee et al., Line Tracking Control of a Two-Wheeled Mobile Robot Using Visual Feedback, International Journal of Advanced Robotic Systems, DOI: 10.5772/53729, received Apr 2012; Accepted 24 Sep 2012 [7] Huu Danh Lam et al., Smooth tracking controller for AGV through junction using CMU camera, Hội nghị Toàn quốc lần thứ Cơ điện tử - VCM-2014 [8] A H Ismail et al., Vision-based System for Line Following Mobile Robot, IEEE Symposium on Industrial Electronics and Applications (ISIEA 2009), October 4-6, 2009, Kuala Lumpur, Malaysia [9] Barbara Siemiatkowska, Mobile Robot Navigation Based on Omnidirectional Sensor [10] Mustafa Engin, Dilúad Engin, Path Planing of Line Follower Robot, Proceedings of the 5th European DSP Education and Research Conference, 2012 [11] F Kaiser et.al., Line Follower Robot: Fabrication and accuracy measurement by data acquisition, International Conference on Electrical Engineering and Information & Communication Technology (ICEEICT) 2014 [12] M S Islam & M A Rahman, Design and Fabrication of Line Follower Robot, Asian Journal of Applied Science and Engineering, Volume 2, No (2013) [13] Khin Hooi Ng et al., Adaptive Phototransistor Sensor for Line Finding, International Symposium on Robotics and Intelligent Sensors 2012 (IRIS 2012) [14] Hsin-Hsiung Huang et al., Hands-on intelligent mobile robot laboratory with support from the industry, IEEE EDUCON Education Engineering 2010 – The future of Global Learing Engineering Education [15] Deepak Punetha, et al Development and Applications of Line Following Robot Based Health Care Management System International Journal of Advanced Research in Computer Engineering & Technology (IJARCET) Volume 2, Issue 8, pp.2446-2449, August 2013 [16] Umar Farooq et al., Fuzzy Logic Reasoning System for Line Following Robot, IACSIT International Journal of Engineering and Technology, Vol 6, No 4, August 2014 [17] Subhash P Rasal Development of Intelligent Line Follower’s Robot International 45 Journal of Emerging Trends in Electrical and Electronics (IJETEE – ISSN: 2320-9569) Vol 7, Issue 2, pp.15-16, Sep-2013 46 [18] 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, 2010 [19] M Zafri Baharuddin et al., Analysis of Line Sensor Configuration for the Advanced Line Follower Robot, Universiti Tenaga Nasional, Malaysia [20] Pascal Dufour, Ole Gudiksen Intelligent line following for vision enabled mobile robots, Master’s thesis Technical University of Denmark, DTU Elektro, pp.6, 2008 [21]: Oguz KOSE et al., PID CONTROLLED LINE FOLLOWER ROBOT DESIGN ON INDOOR 3D NETWORKS [22]: 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 [23]: Richard Wallace et al., First Results in Robot Road – Following, Robotics Institute, Carnegie – Mellon University [24]: Dirman Hanafi et al., Wall Follower Autonomous Robot Development Applying Fuzzy Incremental Controller, Intelligent Control and Automation, 2013, 4, 18-25 [25]: Takanori Fukao et al., Adaptive Tracking Control of a Nonholonomic Mobile Robot, IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION, VOL 16, NO 5, OCTOBER 2000 [26]: R Fierro et al., Control of a Nonholonomic Mobile Robot Using Neural Networks, IEEE TRANSACTIONS ON NEURAL NETWORKS, VOL 9, NO 4, JULY 1998 [27]: Xiaoling Wu et.al., An Improved Hardware Design and Navigation Optimization Algorithm for Line Following Robot, Journal of Convergence Information Technology (JCIT) Volume8, Number5,Mar 2013 [28]: Yutaka Kanayama et al., A Stable Tracking Control Method for an Autonomous Mobile Robot, IEEE 1990 [29]: Iman Anvari, Non-holonomic Differential Drive Mobile Robot Control & Design: Critical Dynamics and Coupling Constraints, Master Thesis, ARIZONA STATE UNIVERSITY, December 2013 [30]: Joseph R.Davis, Coeffiction of Friction In Concise Metals Engineering Data Book, 190-197 United State of America: ASM International, 1997 [31]: Joseph L.Jones, Anita M.Flynn & Bruce A.Seiger Mobile Robot Inspirational to Implementation 2nd ed Cambridge, MA: MIT Artificial Intelligence Laboratory Publication Office, 1998 [32]: Portescap Motion Company, DC Motor Catalogue [33]: Iman Anvari, Non-holonomic Differential Drive Mobile Robot Control & Design: Critical Dynamics and Coupling Constraints, A Thesis Presented in Partial Fulfillment of the Requirement for the Degree Master of Science, Arizona State University, December 2013 [34]: Trịnh Chất & Lê Văn Uyển Tính Tốn Thiết Kế Hệ Dẫn Động Cơ Khí Tập 2, 116117 Việt Nam, Cơng ty In Cơng Đồn Việt Nam, 2006 [35]: Ninh Đức Tốn Dung Sai Lắp Ghép, 54-55 Việt Nam, Công ty Cổ Phần In Thái 47 Nguyên, 2010 [36]: Ninh Đức Tốn Dung Sai Lắp Ghép, 24-39 Việt Nam, Công ty Cổ Phần In Thái Nguyên, 2010 [37]: MISUMI, Stepped Screws Catalogue [38]: VISHAY, TCRT5000, TCRT5000L Datasheet, Document number: 80112, Rev 1.1, 02-Jul-09 [39]: VISHAY, Application of Optical Reflex Sensors TCRT1000, TCRT5000, CNY70, Document number: 80107, Rev 1.1, 02-02 [40]: TOSHIBA Corporation, TB6612FNG Driver IC for Dual DC motor, 2014-10-01 48 ... line (Line Following Robot) dạng robot di động (mobile robot) di chuyển bánh xe Robot di chuyển bám theo đường line làm sẵn mặt đất Quỹ đạo robot phụ thuộc vào sa bàn hệ thống đường line có sẵn... encoder ứng dụng thêm điều khiển PID để điều chỉnh tốc độ vị trí xác theo yêu cầu Về cấu trúc điều khiển: Robot dị line có module bao gồm module sensor, module điều khiển module điều khiển động Trong... robot 0.2 m/s - Mỗi robot mang vật nặng có trọng lượng kg với kích thước tối đa tải trọng (dài x rộng x cao): 200mm x 100mm x 300mm CHƯƠNG 1: TỔNG QUAN Sơ lược Robot dò line: Robot dò line (Line