BÁO cáo đồ án môn cơ điện tử NGHIÊN cứu, THIẾT kế ROBOT dò LINE

Trong khuôn khổ môn học Đồ án môn học thiết kế hệ thống CĐT với đề tài thiết kế robot dò line, chúng em tin tưởng rằng với những kết quả có được từ việc tìm hiểu vàtính toán trong bài ti

TRƯỜNG ĐẠI HỌC BÁCH KHOA HCM

Hà Nội 2021

1

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

NHẬN XÉT CỦA GIÁO VIÊN HƯỚNG DẪN

NHẬN XÉT CỦA GIÁO VIÊN PHẢN BIỆN

3

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

MỤC LỤC

MỞ ĐẦU

CHƯƠNG 1: TỔNG QUAN VỀ ROBOT THÔNG MINH

1.1- KỶ NGUYÊN CỦA ROBOT THÔNG MINH

1.2- CHIẾN LƯỢC PHÁT TRIỂN CÔNG NGHIỆP ROBOT CỦA CÁC QUỐC GIA

1.2.1- Tại các nước trên thế giới

1.2.2- Nghiên cứu robot ở Việt Nam

1.3- GIỚI THIỆU ROBOT DÒ LINE

1.4- SƠ LƯỢC CÁC BƯỚC THỰC HIỆN

CHƯƠNG 2: MÔ HÌNH ĐỘNG HỌC, ĐỘNG LỰC HỌC ROBOT DÒ LINE

2.1 TÍNH TOÁN ĐỘNG HỌC

2.2 TÍNH TOÁN ĐỘNG LỰC HỌC

CHƯƠNG 3: THIẾT KẾ HỆ THỐNG CƠ KHÍ ROBOT DÒ LINE

3.1- LỰA CHỌN CÁC PHƯƠNG ÁN THIẾT KẾ

CHƯƠNG 4: THIẾT KẾ HỆ THỐNG ĐIỀU KHIỂN XE DÒ LINE

4.1 KIT ĐIỀU KHIỂN ARDUINO NANO

4.2- MODULE ĐIỀU KHIỂN ĐỘNG CƠ TB6612

4.3- HỆ THỐNG DÒ ĐƯỜNG

4.4- SƠ ĐỒ KHỐI ROBOT DÒ LINE

4.5- SƠ ĐỒ MẠCH THIẾT KẾ ALTIUM

4.6- CODE ĐIỀU KHIỂN

CHƯƠNG 5- MÔ PHỎNG CHUYỂN ĐỘNG CỦA XE DÒ LINE

5.1- GIỚI THIỆU CÔNG CỤ MÔ PHỎNG VÀ ỨNG DỤNG

5.2- MÔ PHỎNG XE DÒ LINE

LỜI KẾT

DANH SÁCH TÀI LIỆU THAM KHẢO

DANH MỤC HÌNH VẼ

Hình 1.1- Hệ thống xe AGV trong nhà máy

Hình 1.2- Robot an ninh

Hình 1.3- Robot dò line của Nhật Bản

Hình 2.1- Hệ tọa độ robot

Hình 2.2- Mô hình phân tích lực bánh chủ động của robot

Hình 2.3- Cấu tạo động cơ giảm tốc vàng

Hình 3.1: Sơ đồ nguyên lý mô hình xe dò line

Hình 3.2- Bản vẽ 3D xe dò line

Hình 3.3- Bản vẽ 2D xe dò line

Hình 4.1- Kit Arduino Nano với vi điều khiển ATEMEGA328P

Hình 4.2- Sơ đồ chân Arduino Nano

Hình 4.3- Module điều khiển động cơ TB6612

Hình 4.4- Mô hình mạch cầu H

Hình 4.5- Động cơ quay thuận

Hình 4.6- Động cơ quay nghịch

Hình 4.7- Cảm biến hồng ngoại

Hình 4.8- Nguyên lí hoạt động của cảm biến hồng ngoại

Hình 4.9- Sơ đồ thiết kế cảm biến hồng ngoại

Hình 4.10- Sơ đồ nguyên lí module dò line tự thiết kế

Hình 4.11- Sơ đồ đấu nối chân trong mạch 2D

Hình 4.12- Hình 3D module dò line tự thiết kế 2 mặt trên, dưới

Hình 4.13- Sơ đồ khối nguyên lí hoạt động robot dò line

Hình 4.14- Phần mềm thiết kế mạch Altium

Hình 4.15- Sơ đồ mạch nguyên lí của mạch điều khiển

Hình 4.16- Mạch 2D PCB

Hình 4.17- Mạch 3D PCB

5

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Hình 4.18- Lưu đồ thuật toán 49

Hình 5.1- Phần mềm MATLAB 50

Hình 5.2- Biên dạng hoạt động của robot 50

Hình 5.3- Sơ đồ nguyên lý động cơ điện DC 51

Hình 5.4- Sơ đồ khối mạch điện phần ứng 52

Hình 5.5- Sơ đồ khối phần momen điện từ 52

Hình 5.6- Sơ đồ khối phần cần bằng momen trên động cơ 53

Hình 5.7- Sơ đồ khối động cơ với tín hiệu vào điện áp và tín hiệu ra vận tốc 54

Hình 5.8- Sơ đồ khối động cơ với tín hiệu vào điện áp và tín hiệu ra góc quay 55

MỞ ĐẦU

Trong cuộc sống ngày nay, Robot mang tới cho cuộc sống con người một cuộc sốngmới, một cách trải nghiệm cuộc sống và đôi khi còn là người bạn Những hãng Robot(RB) từ các nước nổi tiếng trên thế giới từ Đức, Nhật bản, Nga, Mỹ ngày một khẳng định

sự hiện diện của RB là phần không thiếu trong cuộc sống hiện nay và tương lai của phíatrước Nó xuất hiện ở tất cả các lĩnh vực từ khoa học vĩ mô cho tới vi mô và ngày một đadạng

Trong khuôn khổ môn học Đồ án môn học thiết kế hệ thống CĐT với đề tài thiết kế

robot dò line, chúng em tin tưởng rằng với những kết quả có được từ việc tìm hiểu vàtính toán trong bài tiểu luận này sẽ là bước đệm quan trọng cho việc phát triển nhiều hơnnữa những ý tưởng trong tương lai về tính toán và thiết kế các loại Robot thông minh.Với bố cục gồm:

1- Tổng quan về Robot thông minh, giới thiệu đề tài robot dò line;

2- Tính toán các bài toán chuyển động của robot;

3- Xây dựng mô hình cơ khí cho robot dò line bằng SolidWorks;

4- Xây dựng mạch điều khiển, thuật toán và giải thuật điều khiển;

5- Mô phỏng hoạt động bằng Matlab.

Từ các tính toán ở chương 2, nhóm sẽ đề xuất mô hình thiết kế hệ thống cơ khí vàđiều khiển cho robot dò line bằng một số phần mềm đồ họa mô phỏng

Nhóm chân thành gửi lời cảm ơn tới thầy Nguyễn Văn A, cảm ơn thầy vì những đónggóp qua những bài giảng và những hướng dẫn trong quá trình trao đổi ở các buổi gặpmặt Những góp ý, sửa chữa của thầy sẽ phần nào giúp chúng em tự tin hơn trong cáchthức tiếp cận với nền công nghiệp 4.0 hiện nay Mặc dù đã có những sự chuẩn bị của emhoặc cũng có thể kiến thức em mang đến trong bài báo cáo này con sai sót và chưa đúng;chúng em rất mong có được sự bổ sung, sửa chữa từ thầy cô và các bạn

Chúng em chân thành cảm ơn và chúc thầy sức khoẻ!

7

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

CHƯƠNG 1: TỔNG QUAN VỀ ROBOT THÔNG MINH

Cùng với sự tiến bộ của công nghệ thông tin, robot hiện nay đã trở nên thông minhhơn thế hệ robot truyền thống Chúng đóng vai trò ngày càng quan trọng trong sản xuấtthông minh, hệ thống vận chuyển thông minh, internet vạn vật, dịch vụ thông minh vàsức khỏe y tế Trong thời gian tới, robot thông minh sẽ tiếp tục được tích hợp mở rộngnhiều công nghệ tiên tiến nhất như: cộng tác người - robot, truyền động tích hợp thôngminh, nhận biết cảm xúc, giao diện máy tính - bộ não, mạng dữ liệu lớn, phần mềm sinhhọc và nền tảng đám mây

1.1- KỶ NGUYÊN CỦA ROBOT THÔNG MINH

Năm 2015 chính thức đánh dấu sự ra đời của robot thông minh cùng với sự nổi lên củatrí tuệ nhân tạo Như vậy, công nghệ robot, công nghệ thông tin, công nghệ truyền thông

và trí thông minh nhân tạo chắc chắn sẽ được tích hợp sâu sắc hơn Robot đang chào đónmột kỷ nguyên thông minh mới sau một thời gian dài dừng chân tại thời kỳ của kỹ thuậtđiện và kỹ thuật số Toàn bộ quá trình thay đổi này cho thấy ba điều sau: trước tiên, cáccông nghệ công nghiệp truyền thống như bộ điều khiển, động cơ servo và bộ giảm tốc đãchuyển đổi thành công nghệ trí thông minh nhân tạo như thị giác máy tính, xử lý ngônngữ tự nhiên và học sâu; thứ hai, robot đang thu hút sự quan tâm từ cả những người sửdụng trong công nghiệp và thương mại, trong hộ gia đình và mỗi cá nhân, chứng tỏ robotngày càng hòa nhập sâu rộng vào xã hội loài người; thứ ba, mối quan hệ qua lại độc lậpgiữa người và robot được thay thế bởi sự tương tác chặt chẽ

Robot thông minh là một hệ thống máy được cải thiện về khả năng nhận thức, ra quyếtđịnh và thực thi nhiệm vụ theo cách toàn diện hơn so với robot truyền thống Chúng cóthể mô phỏng ứng xử, cảm xúc và suy nghĩ giống người Với một “bộ não” thông minh,robot có thể thực hiện theo chỉ dẫn của người vận hành, sau đó hoàn thành nhiều nhiệm

vụ đã được lập trình trước, tự học và nâng cấp ứng xử của chúng trong lúc tương tác vớicon người Thực tiễn cho thấy, vai trò của robot thông minh trong cuộc sống xã hội và

9

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

sản xuất sẽ ngày càng trở nên quan trọng Xuất phát từ môi trường ứng dụng, có thể phânchia robot thông minh thành các loại robot sau:

Xe tự dẫn hướng (AGV) được trang bị thiết bị dẫn hướng tự động là cảm biến điện từhoặc quang, có thể di chuyển dọc theo đường dẫn biết trước đảm bảo an toàn, và có thểhoàn thành nhiều công việc vận chuyển

Hình 1.1- Hệ thống xe AGV trong nhà máy

Robot dịch vụ trong nhà: ví dụ như robot quét và lau cửa sổ, có thể làm việc giống trợ

lý giúp việc trong hộ gia đình Chúng cũng có khả năng tìm kiếm thăm dò, tự động lập kếhoạch đường đi và tránh vật cản Nhiều loại robot dịch vụ khác, như robot xã hội hóa giađình, robot bầu bạn, robot trợ lý di động, robot huấn luyện thú cưng, đều có khả năngtương tác với người, cũng như hoàn thành các nhiệm vụ được giao, chăm nom người già

và trẻ nhỏ, nhắc nhở sự kiện và tuần tra nhà Bên cạnh đó, còn có robot giao tiếp cảmxúc, robot giáo dục trẻ nhỏ, robot nền học thông minh, UAV cá nhân, robot di động cánhân được hỗ trợ thêm công nghệ tương tác giọng nói cho phép tương tác giao tiếp vàcảm nhận cảm xúc của con người Nhiều robot dịch vụ thương mại, bao gồm cả robotnhận thức, robot hướng dẫn mua hàng, robot nấu ăn, robot văn phòng, robot an ninh cóthể tùy biến dịch vụ cá nhân theo tình huống ứng dụng cụ thể và hoàn thành nhiều nhiệm

vụ như quảng cáo, cung cấp chỉ dẫn, tư vấn hỗ trợ, trợ lý công việc văn phòng, thực hiệntuần tra an ninh

Hình 1.2- Robot an ninh

Robot chuyên dụng (hay còn gọi là robot đặc biệt): là những robot ứng dụng cho môitrường đặc biệt Chúng có thể hỗ trợ để hoàn thành nhiều nhiệm vụ trong môi trườngnguy hiểm và hỗn loạn hoặc công việc yêu cầu độ chính xác cao Ví dụ: robot y học cungcấp giải pháp tiên tiến để điều trị phẫu thuật và phục hồi chức năng, chúng giảm thiểunhững khó khăn của điều trị và khám bệnh, đồng thời rút ngắn thời gian hồi phục, nhưrobot phẫu thuật, robot chỉnh hình, robot nội soi, robot phục hồi chức năng, bộ phận giảthông minh, robot phục vụ người cao tuổi và robot điều dưỡng Robot quân sự (trinh sát

do thám, phá mìn, UAV ) đã có một lịch sử phát triển dài và đã được đưa vào chiếntrường để vận chuyển nguyên vật liệu, tìm kiếm và khảo sát, tấn công mục tiêu, cứu hộ,chống khủng bố Liên quan tới mục đích khám phá còn có robot không gian, robot dướinước, robot đường ống là những loại robot có thể thực hiện nhiều nhiệm vụ khó khănthay cho con người Ngoài ra, còn một số dạng robot cho nghiên cứu khoa học và ứngdụng mũi nhọn như robot nano, robot sinh học, robot bầy đàn

Công nghệ robot là một công nghệ phức tạp và tiên tiến liên quan đến đa lĩnh vực vàliên ngành, bao gồm cơ khí - điện tử, điều khiển tự động, công nghệ cảm biến, công nghệmáy tính, vật liệu mới, công nghệ sinh học và trí thông minh nhân tạo (sẽ còn tiếp tụcđược tích hợp mở rộng) Nó được công nhận là một lĩnh vực công nghệ cao có ảnhhưởng quan trọng tới sự phát triển của những công nghệ đang nổi trong tương lai Như làmột một nền tảng công nghệ quan trọng, nó không chỉ hỗ trợ chủ đạo cho phát triển sảnxuất tiên tiến, mà còn giúp mang tới cho cuộc sống nhiều biến đổi đột phá

11

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

1.2- CHIẾN LƯỢC PHÁT TRIỂN CÔNG NGHIỆP ROBOT CỦA CÁC

QUỐC GIA 1.2.1- Tại các nước trên thế giới

Công nghiệp robot thông minh là một tiêu chuẩn quan trọng để đánh giá mức độ tântiến về công nghệ và cấp độ sản xuất cao nhất của một quốc gia Để nắm bắt cơ hội pháttriển và chiếm vị thế cạnh tranh mũi nhọn trong lĩnh vực này, những nền kinh tế chủ lựctrên thế giới đã liên tục đề ra các chiến lược phát triển công nghiệp robot Một số quốcgia đầu tư sớm đã thu được nhiều thành quả xứng đáng như: Hoa Kỳ, một số quốc giachâu Âu, Nhật Bản, Hàn Quốc

Hoa Kỳ:

Là quốc gia đầu tiên phát triển và xúc tiến đẩy mạnh ứng dụng robot, nước này hiệnđang giữ vai trò dẫn đầu trong công nghệ robot thông minh Năm 2011, Hoa Kỳ đã bắtđầu thực hiện kế hoạch Chung tay cùng sản xuất tiên tiến (Advanced ManufacturingPartnership - AMP), trong đó tuyên bố tiếp sức cho công nghiệp sản xuất bằng robot,phát triển một thế hệ robot thông minh mới dựa trên việc khai thác thế mạnh của côngnghệ thông tin, đồng thời đầu tư 70 triệu USD cho nghiên cứu những robot thế hệ tiếptheo Cùng năm đó, Trường Đại học Carnegie Mellon đã khởi công kế hoạch robot quốcgia (National Robot Plan), nhắm mục tiêu giúp Hoa Kỳ giữ vững vai trò dẫn đầu tronggiai đoạn kế tiếp của công nghệ robot và ứng dụng Năm 2013, nước này phát hành cuốn

“The Robot Roadmap: From Internet to robot”, đặt robot vào vị trí quan trọng ngangbằng với internet thế kỷ XX, và nhấn mạnh tầm quan trọng của công nghệ robot trongsản xuất và sức khỏe y tế Phiên bản mới nhất của “The Robot roadmap” đã được pháthành năm 2016, đưa ra hướng dẫn về chính sách và kỹ thuật cho việc ứng dụng robottrong thiết bị lặn không người lái, cộng tác người - robot và giáo dục chăm sóc sức khỏe.Trong cùng năm, kế hoạch robot quốc gia 2.0 đã được thực hiện, nhằm tạo ra hàng loạtrobot cộng tác giúp thiết lập một mối quan hệ cộng sinh giữa robot và con người

Châu Âu:

Tại đây, đổi mới công nghệ robot đã và đang là một lĩnh vực chủ đạo được ưu tiên,

vực Năm 2013 “Kế hoạch công nghiệp 4.0” của Đức cũng dự định duy trì vai trò tiênphong của họ trong công nghiệp chế tạo, đồng thời coi công nghệ sản xuất thông minh vàcông nghệ robot như là sự khởi đầu của cách mạng công nghiệp mới Trong năm đó,Pháp đã đầu tư 129,6 triệu USD vào công nghiệp robot với mục đích tạo điều kiện thuậnlợi cho phát triển bền vững của công nghiệp robot.

Nhật Bản:

Là một cường quốc robot, Nhật Bản đã đề ra chiến lược phát triển dài hạn cho ngànhcông nghệ này Chính phủ Nhật Bản dự tính đổ nhiều tiền cho phát triển công nghiệprobot, đưa lĩnh vực này trở thành một trụ cột quan trọng hỗ trợ tăng trưởng kinh tế quốcgia Tháng 6/2014, Chiến lược phục hồi Nhật Bản đã được đề xuất với mục tiêu phátđộng một cuộc cách mạng công nghiệp mới được vận hành bởi robot Tiếp đó, Ủy bancải cách robot được thành lập, phát triển robot công nghiệp được đưa vào danh sách 3nhiệm vụ chủ đạo trong thế kỷ mới Năm 2015, Chiến lược mới về robot đã được banhành, nhằm tích hợp sâu robot với công nghệ máy tính, dữ liệu lớn, mạng và trí thôngminh nhân tạo, với chủ đích tạo ra một nền công nghiệp robot đẳng cấp thế giới, xâydựng một xã hội ứng dụng robot và trở thành nước dẫn đầu về robot thông minh trongthời đại mới

Ngoài ra, một số quốc gia đã và đang âm thầm xây dựng chiến lược phát triển phù hợpvới mục đích của họ, ví dụ như Trung Quốc - quốc gia hiện đang sử dụng robot côngnghiệp nhiều nhất trên thế giới

1.2.2- Nghiên cứu robot ở Việt Nam

Tại Việt Nam, nghiên cứu phát triển robot đã và đang được triển khai ở hầu hết cáctrường đại học, viện nghiên cứu trong cả nước Trong đó, nổi bật ở Hà Nội là Trường Đạihọc Bách khoa Hà Nội, Viện Công nghệ thông tin, Viện Cơ học (Viện Hàn lâm Khoa học vàCông nghệ Việt Nam), Học viện Kỹ thuật Quân sự, Viện Nghiên cứu Điện tử, Tin học và Tựđộng hoá; ở TP Hồ Chí Minh là Trường Đại học Bách khoa, Trường Đại học Sư phạm Kỹthuật, Viện Cơ học và Tin học Ứng dụng, Phân viện Nghiên cứu điện tử, Tin học và Tựđộng hóa, Trung tâm Nghiên cứu và Phát triển (Khu Công nghệ cao TP

13

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Hồ Chí Minh) Đội ngũ nhà khoa học đã quan tâm và tập trung giải quyết một số vấn đềliên quan tới hệ thống robot như thiết kế tối ưu, động học, động lực học, điều khiển, thiết

kế phần cứng, lập trình phần mềm song những nghiên cứu này phần lớn liên quan tớivấn đề học thuật, tạo cơ sở khoa học làm nền tảng ban đầu cho giai đoạn phát triển robottiếp theo Nhìn chung, nghiên cứu và ứng dụng robot ở Việt Nam vẫn còn nhiều hạn chế,nổi bật là những vấn đề sau:

- Đào tạo nguồn nhân lực và nghiên cứu chuyên sâu về robot còn yếu và thiếu, nhưthiếu mô hình robot vật lý, thiết bị cho thí nghiệm, thử nghiệm Kết quả thi Robocon của sinh viênViệt Nam so với sinh viên nước bạn là đáng ghi nhận, nhưng điều này chỉ phản ánh được phần nào

về mặt ý tưởng

- Robot được chế tạo tại Việt Nam còn rất ít và hầu hết sử dụng công nghệ cũ của thế giới, chưa có đủ khả năng làm chủ công nghệ cũng như phát triển công nghệ phù hợp

- Robot công nghiệp đã được quan tâm nghiên cứu nhưng mới chỉ dừng ở việc đưa ra

mô hình và đi tìm thuật toán giải bài toán động lực học cho robot phục vụ điều khiển chuyển động,chưa chủ động được quá trình thiết kế và chế tạo robot đáp ứng yêu cầu cụ thể Nhiều vấn đề mớiđang được quan tâm trên thế giới nhằm nâng cao kỹ năng động lực học và khả năng ứng xử thôngminh giống con người cho robot chưa có điều kiện để nghiên cứu sâu ở Việt Nam như: vấn đề tránhvật cản, tránh điểm kỳ dị… và đặc biệt là vấn đề tương tác lực của robot với môi trường trong quátrình thực hiện nhiệm vụ chuyển động

- Robot nói chung và robot công nghiệp thông minh nói riêng đang được sử dụng tạiViệt Nam phần lớn được nhập khẩu Có rất ít công ty sản xuất và phân phối sản phẩm trong nước.Nếu có thì hầu hết sản phẩm thuộc phân loại robot công nghiệp truyền thống, hạn chế về tính thôngminh, bậc tự do, kỹ năng động lực học nâng cao

Xu hướng chuyển dịch sản xuất từ các nước phát triển sang các nước đang phát triểntrong thập kỷ vừa qua, tất yếu làm gia tăng nhu cầu sử dụng robot công nghiệp ở thịtrường các nước đang phát triển Tuy nhiên, việc hấp thụ công nghệ và sử dụng hệ thốngrobot công nghiệp hiện đại, đa năng tại doanh nghiệp vừa và nhỏ ở Việt Nam còn gặp

khó khăn về mặt chi phí (giá quá cao) và không hiệu quả về mặt ứng dụng (không sửdụng hết chức năng sẵn có của robot).

1.3- GIỚI THIỆU ROBOT DÒ LINE

Những loại robot tự động đang được đưa vào sử dụng hiện nay đều có thể làm việcsuốt 24 giờ trong cả tuần và doanh nghiệp chẳng cần lo lắng chúng sẽ xin nghỉ phép haynghỉ việc Các robot cũng tự động tuần tra theo tuyến đường và các chế độ đã lập trìnhsẵn mà không hề biết đến khái niệm lãn công hay tắc trách

Đồng thời vì là máy móc nên chúng chịu được cường độ công việc cao hơn so với conngười Ví dụ một nhân viên dịch vụ bảo vệ có thể đi tuần 7 lần/ngày thì robot lại có thểtuần tra 20 lần/ngày với quãng đường 24km, đặc biệt hữu dụng trong dịch vụ bảo vệ nhàmáy hoặc những nơi có diện tích rộng

Robot dò line được áp dụng trong cuộc sống khi có thể di chuyển để phát hiện những

sự cố bất thường ở các trạm tàu điện ngầm hoặc di chuyển theo line mang theo hàng hóatrong các khu công nghiệp

Hình 1.3- Robot dò line của Nhật Bản

1.4- SƠ LƯỢC CÁC BƯỚC THỰC HIỆN

- Vận tốc di chuyển lớn nhất

b) Phân tích và lựa chọn phương án

Đây là bước đầu tiên của quá trình thiết kế nhằm đưa ra hướng giải quyết vấn đề:

- Đề xuất phương án khả thi: cơ khí, điện, điều khiển

- Đánh giá và lựa chọn phương án thiết kế

- Tìm hiểu và đánh giá các thiết bị trên thị trường để thực hiện phương án: động

cơ, vi điều khiển…

c) Thiết kế hệ thống điện – điện tử

Với các phương án điện đã chọn, tiến hành lựa chọn thông số và sử dụng các thiết bị, kết hợp các thiết bị thành một khối hoàn chỉnh Công việc bao gồm:

Lựa chọn thông số vi điều khiển, các mô đun công suất và cảm biến

Sử dụng được các cảm biến của robot, thiết kế bộ điều khiển sử dụng hồi tiếp vận tốc để điều khiển động cơ

d) Xây dựng giải thuật điều khiển

Tiến hành thiết kế các giải thuật điều khiển cho robot với các công việc sau:

Thiết kế giải thuật tìm đường trên máy tính cho một hệ thống line cụ thể;

Thiết kế giải thuật điều khiển robot tự hành để đáp ứng các yêu cầu

Lập trình vi điều khiển trên robot;

f) Thực nghiệm và đánh giá kết quả

- Tiến hành thực nghiệm;

- Đánh giá kết quả thực nghiệm, nêu lên những hạn chế của giải thuật và mô hình

v max =1.5 m/ s.

CHƯƠNG 2: MÔ HÌNH ĐỘNG HỌC, ĐỘNG LỰC HỌC ROBOT DÒ LINE

2.1 TÍNH TOÁN ĐỘNG HỌC

Hình 2.1- Hệ tọa độ robot

Hệ tọa độ tuyệt đối ( hệ tọa độ gốc) là hệ tọa độ cố định được đặt trong môi trường vàđược biểu diễn bằng (X,Y) Hệ tọa độ tương đối ( hệ tạo độ robot) là hệ tọa độ gắn liềnvới robot và được biểu thị bằng (X r, Y r) Gốc của hệ tọa độ robot là P

Vị trí robot so với hệ tọa độ robot được xác định bằng ma trận vị trí

17

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Để chuyển đổi vị trí của robot từ hệ tạo độ tương đối (P X r Y r) sang hệ tọa độ tuyệt đối

(OXY) ta sử dụng ma trận chuyển đổi R được xác định như sau:

Trong đó R(θ) là ma trận quay của robot quanh trục thẳng đứng, với:) là ma trận quay của robot quanh trục thẳng đứng, với:

Vận tốc tuyến tính của robot trong hệ tọa độ bằng trung bình vận tốc tuyến tính của hai

bánh xe theo hệ tọa độ robot:

Các vận tốc của robot trong hệ tọa độ có thể biểu diễn dưới dạng các vận tốc của điểm

trung tâm P trong khung robot như sau:

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Thay vào ta được:

Ma trận vận tốc theo hệ tuyệt đối được thể hiện như sau:

Với R = 0.0325 (m) là bán kính bánh xe của robot

L= 0.112 (m) : là khoảng cách giữa 2 bánh xe φ˙ R , φ˙ L =0.4( m/ s): là vận tốc của bánh phải, trái của robot

θ= 0 (độ): là góc quay của bánh xeThay vào ta được:

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Phương trình Lagrange được viết dưới dạng như sau:

Trong đó:

K: là động năng của hệ;

P: là thế năng của hệ;

Q¿i: là ngoại lực

Hình 2.2- Mô hình phân tích lực bánh chủ động của robot

Cấu trúc chuyển động của hệ gồm 2 bánh sau dẫn động và 1 bánh đa hướng phíatrước dẫn hướng Vì vậy mọi chuyển động của robot phụ thuộc vào việc điều khiển vậntốc 2 bánh sau v wR và v wL

Ta có tổng động năng của robot:

Động năng tịnh tiến của thân xe:

Trong đó:

K tt : là động năng tịnh tiến của thân xe; m t: là khối lượng thân xe;

v t: là vận tốc dài của xe;

Động năng của bánh xe:

Trong đó:

K b: là động năng của bánh xe;

J wR ,J wL: là momen quán tính của từng bánh xe; Coi bánh xe là đĩa tròn mỏng thì:

Thế năng của robot:

Xét robot chạy trên mặt phẳng nên thế năng bằng 0

Ngoại lực của robot:

M mst: là momen hao tổn trên trục;

M msl: là momen ma sát lăn;

R: là bán kính bánh xe;

G: là gia tốc trọng trường;

K: là hệ số ma sát bánh xe với mặt đường;

V b ,V a: là vận tốc tại điểm A,B (m/s);

t: là thời gian di chuyển từ A đến B (s).

Thay số vào, ta được :

Vì thế ta chọn động cơ có mô men lớn hơn số liệu tính toán trên

Bảng lựa chọn phương án cho động cơ

Phương án Hình ảnh Ưu điểm Nhược điểmĐộng cơ - Có thể điều - Hiện tượngbước khiển chính xác trượt bước, muốn

vị trí theo bước hồi tiếp cần gắn

them encoder,lúc dừng tại 1 vịtrí động cơ ngậmđiện để giữ rotor

- TránhĐộng cơ được hiện tượng Thiết lập bộ diềuservo trượt bước như khiển phức tạp

Step DC, Giá thành cao

- Hoạt động ở tốc

23

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

độ cao, momenxoắn cao,

xác trong góc giớihạn, kiểm soát vịtrí chính xác

Động cơ - Tốc độ tỉ lệ với - Tản nhiệt kém

encoder dụng, đặc tuyến

torque/dòngtuyến tính, khảnăng bị quá tảithấp Giá thànhthấp

Động cơ - Với giá thành - Chỉ dùng với cácgiảm tốc rẻ, dễ sử dụng mô hình nhỏ, taivàng 3-9V nên chiếc động trọng và momen

cơ này được sử thấpdụng rất nhiều

với mô hìnhnghiên cứu cácnghành kĩ thuật.

Ta chọn Động cơ sau:

24

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Hình 2.3- Cấu tạo động cơ giảm tốc vàng 3-9V

CHƯƠNG 3: THIẾT KẾ HỆ THỐNG CƠ KHÍ ROBOT DÒ LINE

3.1- LỰA CHỌN CÁC PHƯƠNG ÁN THIẾT KẾ

Đặc điểm và yêu cầu của xe:

- Xe di chuyển trên địa hình bằng phẳng, không có dốc nghiêng

- Xe di chuyển với đường line liên tục không bị đứt đoạn

- Các vị trí giao nhau trên sa bàn: A, B, D có thể rẽ theo yêu cầu

Phương án thiết kế cơ khí:

Bảng 3.1: So sánh các ưu nhược điểm cho sơ đồ nguyên lý robot dò line

án

- Xe có kết cấu - Gặp khó khănđơn giản, dễ trong vấn đề

2 bánh chủ thiết kế vừa bám line,

Xe 2 động, không - Xe có khả vừa tự cân bằng

bánh có bánh bị năng xoay xe

- Xe di chuyển

26

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

với tốc độ thấp.

- Ba bánh xe - Dễ bị văngluôn đồng khỏi đường linephẳng, đảm khi có lực nhỏ

Xe 2 bánh bảo cả ba bánh tác dụng vàochủ động đặt xe đều tiếp xúc bánh bị động ởphía sau, 1

bánh bị động

đặt phía trước đơn giản lật khi mang tải

- Khả năng qua nặng

2 bánh chủ - Ba bánh xe - Qua cua dễ bịđộng đặt phía luôn đồng lật khi mang tảitrước, 1 bánh phẳng, đảm nặng

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

hơn so vớibánh bị động ởphía trước.

- Kết cấu cơ khíđơn giản

- Khả năng quacua dễ dàng

- Xe có kết cấu - Không đảm

cơ khí đơn bảo 4 bánh xegiản luôn tiếp xúc

2 bánh chủ - Do có 4 bánh với mặt đất.động và 2 nên không bị - Qua cua tốcbánh bị Sơ đồ nguyên lý lật khi đi qua độ thấp do có 2

nên kém linhhoạt

- Xe bẻ lái dễ - Kết cấu cơ khídàng khi qua phức tạp, khócua chế tạo

2 bánh chủ - Không bị lật - Khó điểuđộng và 2 khi mang tải khiển

thống treo.

- Cấu trúc bốnbánh có các - Điểu khiểndạng giúp phân phức tạp.phối đều lực - Qua cua khó

Lựa chọn phương án 2a: Xe gồm có 3 bánh, trong đó 2 bánh chủ động đặt ở

phía sau và 1 bánh bị động đặt ở phía trước Để đảm bảo 3 bánh tạo được độ

đồng phẳng tốt,

Dưạ trên các yêu cầu đưa ra và đặc điểm của các thiết kế trên ta lựa chọn

phương án thiết kế hình dáng robot dò line như sau:

Hình 3.1: Sơ đồ nguyên lý mô hình xe dò line

29

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

1234

Mạch dò lineThân robotBánh xe đa hướngBánh xe chủ động

Thiết kế mô hình 3D bằng phần mềm SolidWorks

Hình 3.2- Bản vẽ 3D xe dò line

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

Hình 3.3- Bản vẽ 2D xe dò line CHƯƠNG 4: THIẾT KẾ HỆ THỐNG ĐIỀU KHIỂN XE DÒ LINE

Trong quá trình tìm hiểu và nghiên cứu, nhóm đồ án đã biết được ưu, nhược củanhiều loại thiết bị khác nhau từ đó đã đưa ra được sự lựa chọn các thiết bị phù hợp

nhất cho đồ án này Dưới đây là các thiết bị đó:

4.1 KIT ĐIỀU KHIỂN ARDUINO NANO

Arduino Nano là phiên bản nhỏ gọn của Arduino Uno R3 sử dụng MCU

ATmega328P-AU dán, vì cùng MCU nên mọi tính năng hay chương trình chạytrên Arduino Uno đều có thể sử dụng trên Arduino Nano, một ưu điểm của

Arduino Nano là vì sử dụng phiên bản IC dán nên sẽ có thêm 2 chân Analog A6,A7 so với Arduino Uno

Hình 4.1- Kit Arduino Nano với vi điều khiển ATEMEGA328P

Thông số kỹ thuật:

IC chính: ATmega328P-AU

IC nạp và giao tiếp UART: CH340

Điện áp cấp: 5VDC cổng USB hoặc 6-9VDC chân Raw

Mức điện áp giao tiếp GPIO: TTL 5VDC

Dòng GPIO: 40mA

Số chân Digital: 14 chân, trong đó có 6 chân PWM

Số chân Analog: 8 chân (hơn Arduino Uno 2 chân)

Flash Memory: 32KB (2KB Bootloader)

SRAM: 2KB; EEPROM: 1KBClock Speed: 16Mhz

Tích hợp Led báo nguồn, led chân D13, LED RX,

Hình 4.2- Sơ đồ chân Arduino Nano

- Cac chân: 1, 2, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15 và 16

Như đã đề cập trước đó, Arduino Nano có 14 ngõ vao/ra digital Các chân làmviệc với điện áp tôi đa la 5V Mỗi chân có thể cung cấp hoặc nhận dòng điện40mA và có điện trở kéo lên khoảng 20-50kΩ Cac chân có thể được sử dụng làm

đầu vào hoặc đầu ra, sử dụng các hàm pinMode (), digitalWrite () và digitalRead()

Ngoài các chức năng đầu vào và đầu ra sô, các chân nay cũng có một số chứcnăng bổ sung

- Chân 1, 2: Chân nối tiếpHai chân nhận RX và truyền TX này được sử dụng để truyền dữ liệu nối tiếpTTL Các chân RX và TX được kết nối với các chân tương ứng của chip nối tiếp

USB tới TTL

- Chân 6, 8, 9, 12, 13 và 14: Chân PWM

Mỗi chân số này cung cấp tín hiệu điều chế độ rộng xung 8 bit Tín hiệu PWM

có thể được tạo ra bằng cách sử dụng hàm analogWrite ()

- Chân 5, 6: Ngăt

Khi chúng ta cần cung cấp một ngắt ngoài cho bộ xử lý hoặc bộ điều khiểnkhác, chúng ta có thể sử dụng các chân này Các chân này có thể được sử dụng để

cho phép ngắt INT0 và INT1 tương ứng bằng cách sử dụng hàm attachInterrupt ()

Các chân có thể được sử dụng để kích hoạt ba loại ngắt như ngắt trên giá trị thấp,

tăng hoặc giảm mức ngăt và thay đổi giá trị ngăt

- Chân 13, 14, 15 và 16: Giao tiếp SPI

Khi bạn không muốn dữ liệu được truyền đi không đồng bộ, bạn có thể sử dụngcác chân ngoại vi nối tiếp này Các chân này hỗ trợ giao tiêp đồng bộ với SCK

Mặc dù phần cứng có tính năng này nhưng phần mềm Arduino lại không có Vì

vậy, bạn phải sử dung thư viện SPI để sử dụng tính năng này

- Chân 16: Led

Khi ban sư dung chân 16, đèn led trên bo mach se sang

- Chân 18, 19, 20, 21, 22, 23, 24, 25 và 26 : Ngõ vao/ra tương tư

Như đã đề cập trước đó UNO có 6 chân đầu vào tương tự nhưng Arduino Nano

có 8 đầu vào tương tự (19 đến 26), được đánh dấu A0 đến A7 Điều này có nghĩa làbạn có thể kết nối 8 kênh đầu vào tương tự để xử lý Mỗi chân tương tự này có một

ADC có độ phân giải 1024 bit (do đó nó sẽ cho giá trị 1024) Theo mặc định, cácchân được đo từ mặt đất đến 5V Nếu bạn muốn điện áp tham chiếu là 0V đến3.3V, co thê nôi vơi nguôn 3.3V cho chân AREF (pin thứ 18) bằng cách sử dụngchức năng analogReference () Tương tự như các chân digital trong Nano, các chânanalog cũng có một số chức năng khác

- Chân 23, 24 như A4 và A5: chuân giao tiêp I2CKhi giao tiêp SPI cũng có những nhược điểm của nó như cần 4 chân và giới hạntrong một thiết bị Đối với truyền thông đường dài, cân sử dụng giao thức I2C I2C

hỗ trợ chỉ với hai dây Một cho xung (SCL) và một cho dữ liệu (SDA) Để sử dụng

tính năng I2C này, chúng ta cần phải nhập một thư viện có tên là Thư viện Wire

34

TIEU LUAN MOI download : skknchat123@gmail.com moi nhat

- Chân 18: AREF

Điện áp tham chiếu cho đầu vào dùng cho việc chuyển đổi ADC

- Chân 28 : RESETĐây la chân reset mach khi chung ta nhân nut rên bo Thường được sử dụng để được kết nối với thiết bị chuyển mạch để sử dụng làm nút reset

4.2- MODULE ĐIỀU KHIỂN ĐỘNG CƠ TB6612

Các phương án lựa chọn module điều khiển động cơ

Phương án Hình ảnh minh họa Ưu điểm Nhược điểm

Cầu H đôi, tiết Dòngkiệm diện tích (2A),mạch và số điều khiển.chân điều

khiển dễ dàng nhanh