ĐẠI HỌC QUỐC GIA THÀNH PHỐ HỒ CHÍ MINH TRƢỜNG ĐẠI HỌC BÁCH KHOA -------------------- TRẦN HỮU PHƢỚC NGHIÊN CỨU XÂY DỰNG PHƢƠNG PHÁP ĐIỀU KHIỂN ROBOT TỰ HÀNH DẠNG CHÂN Chuyên ngành : Kỹ Thuật Cơ Khí Mã số : 60520103 LUẬN VĂN THẠC SĨ TP. HỒ CHÍ MINH, tháng 06 năm 2015 Công trình đƣợc hoàn thành tại: Trƣờng Đại Học Bách Khóa-ĐHQG-HCM Cán bộ hƣớng dẫn khoa học: .TS Trần Thiên Phúc (Ghi rõ họ tên, học hàm, học vị và chữ ký) Cán bộ chấm nhận xét 1:. (Ghi rõ họ tên, học hàm, học vị và chữ ký) Cán bộ chấm nhận xét 2:. (Ghi rõ họ tên, học hàm, học vị và chữ ký) Luận văn thạc sĩ đƣợc bảo vệ tại Trƣờng Đại học Bách Khoa, ĐHQG Tp.
năm 2015 Thành phần Hội đồng đánh giá luận văn thạc sĩ gồm: 1. Xác nhận của chủ tịch Hội đồng đánh giá LV và Trƣởng khoa quản lý chuyên ngành sau khi luận văn đã đƣợc chỉnh sửa (nếu có). CHỦ TỊCH HỘI ĐỒNG TRƢỞNG KHOA CƠ KHÍ ii ĐẠI HỌC QUỐC GIA TP. HCMCỘNG HÕA XÃ HỘI CHỦ NGHĨA VIỆT NAM TRƢỜNG ĐẠI HỌC BÁCH KHOA Độc lập – Tự do – Hạnh phúc -------------------------- ------------------- NHIỆM VỤ LUẬN VĂN THẠC SĨ Họ tên học viên: TRẦN HỮU PHƢỚC MSHV: 13041062 Ngày, tháng, năm sinh: 01/01/1988 Nơi sinh: Đồng Nai Chuyên ngành: Kỹ thuật Cơ Khí Mã số : 60520103 NGHIÊN CỨU XÂY DỰNG PHƢƠNG PHÁP ĐIỀU I.
TÊN ĐỀ TÀI: KHIỂN ROBOT TỰ HÀNH DẠNG CHÂN II. NHIỆM VỤ VÀ NỘI DUNG: - Nghiên cứu các về dáng đi của robot 4 chân về sơ đồ bƣớc, vị trí đặt chân. - Nghiên cứu về động học và động lực học của robot - Lập trình , thực nghiệm với các dáng đi đã nghiên cứu, so sánh và nhận xét để tìm ra dáng đi phù hợp III. NGÀY GIAO NHIỆM VỤ : 19/01/2015 IV.
NGÀY HOÀN THÀNH NHIỆM VỤ: 14/06/2015 V. CÁN BỘ HƢỚNG DẪN (Ghi rõ học hàm, học vị, họ, tên): PSG. TRẦN THIÊN PHÖC Tp. năm 2015 CÁN BỘ HƢỚNG DẪN 1 CHỦ NHIỆM BỘ MÔN ĐÀO TẠO (Họ tên và chữ ký) (Họ tên và chữ ký) PGS.
Trần Thiên Phúc TRƢỞNG KHOA CƠ KHÍ (Họ tên và chữ ký) iii LỜI CẢM ƠN Lời đầu tiên tôi xin chân thành cảm ơn thầy PGS.TS Trần Thiên Phúc đã tận tình giúp đỡ và hƣớng dẫn tôi trong suốt thời gian học tại trƣờng Đại Học Bách Khoa mà đặc biệt là thời gian làm luận văn. Xin chân thành cảm ơn quý Thầy Cô trong khoa cơ khí trƣờng Đại học Bách Khoa TP. Hồ Chí Minh. Các thầy cô đã truyền đạt kiến thức cho tôi và luôn sẳng sàng hƣớng dẫn tôi khi tôi có những thắc mắc liên quan đến luận văn.
Xin cám ơn trƣờng Cao đẳng nghề Lilama2 nơi tôi công tác đã tạo điều kiện cho tôi đi học và cho tôi phòng Lab để thực nghiệm mô hình robot. Đồng thời cũng cám ơn các em sinh viên của trƣờng đã phụ giúp tôi trong phần thực nghiệm này. Xin cám ơn đến các đồng nghiệp và bạn trong lớp thạc sĩ Kỹ Thuật Cơ Khí khóa 2- 3013 đã luôn bên tôi khi tôi có những khó khăn cần chia sẻ về đề tài. Xin cám ơn gia đình đã bên cạnh tôi.
HCM ngày 25 tháng 05 năm 2015 Trần Hữu Phƣớc i TÓM TẮT Mục tiêu của luận văn này là nghiên cứu loại robot di chuyển bằng bốn chân về độ ổn định, kiểu dáng di chuyển, phƣơng pháp chuyển hƣớng, động học và động lực học của robot. Từ kết quả trên ngƣời nghiên cứu trên ta tiến hành thực nghiệm với các kiểu dáng di chuyển + Dáng di chuyển liên tục + Dáng di chuyển hai phase không liên tục + Dáng di chuyển bốn phase không liên tục Với mỗi kiểu dáng di chuyển trên ta tiến hành thực nghiệm. Robot sử dụng 12 động cơ Rc servo đƣợc điều khiển bởi vi điều khiển DS Pic 30F4011. Ta dùng webcam logitech C310 để nhận diện ảnh của robot từ đó xác định tâm hiện tại của nó.
Webcam này giao tiếp với máy tính thông qua phần mềm Matlap 2012. Tập hợp quỹ đạo của tâm robot ta vẽ lên đồ thị cho mỗi kiểu dáng di chuyển. Từ đó ta rút ra nhận xét kiểu di chuyển nào đạt độ ổn định cao nhất đối với mô hình robot hiện đang có. ii ABSTRACT The aim of this thesis is to study about the moving of Quadruped robot in relation with stability, gait, methods of navigation, kinematics and dynamics.
From the above researching results, researcher practices with the differential moving such as: - Continuous moving - Moving two phase discontinuous - Moving four phase discontinuous Robot uses 12 Rc servo motor, controlled by microcontroller DC PIC30F4011. Using Webcam Logitech C310 to identify the image of robot, thereby determine its current center point. This Webcam communicates with Computer through Software Matlab 2012. Gather all of center trajectory of robot, we can build the graph for each moving method.
With these Graph we can know which moving is the highest stability for this robot model. iii LỜI CAM ĐOAN Tôi xin cam đoan đây là đề tài nghiên cứu do tôi thực hiện dƣới sự hƣớng dẫn của PGS. Trần Thiên Phúc Các kết quả trình bày là trung thực, các tài liệu tham khảo đều có nguồn gốc xuất xứ rõ ràng. Tôi xin chịu trách nhiệm về nghiên cứu của mình TP.HCM, Ngày 25 tháng 05 năm 2015 Trần Hữu Phƣớc iv MỤC LỤC LỜI CẢM ƠN.
ii LỜI CAM ĐOAN. iv MỤC LỤC. v DANH MỤC HÌNH ẢNH. vii DANH MỤC BẢNG BIỂU.
ix CHƢƠNG 1 : TỔNG QUAN. Giới thiệu về robot .2 Ƣu nhƣợc điểm của robot di chuyển bằng chân .1 Ƣu điểm của robot di chuyển bằng chân .2 Nhƣợc điểm của robot di chuyển bằng chân .3 Tiềm năng và ứng dụng của robot di chuyển bằng chân .4 Nội dung nghiên cứu của đề tài. 10 CHƢƠNG 2 : PHÂN TÍCH ĐỘ ỔN ĐỊNH CỦA ROBOT.1 Các phƣơng pháp điều khiển robot .1 Phƣơng pháp điều hƣớng có tính toán .2 Phƣơng pháp điều hƣớng theo phản ứng .2 Phƣơng pháp điều hƣớng kết hợp .2 Một số định nghĩa trong quá trình phân tích dáng đi .3 Độ ổn định của robot. 19 CHƢƠNG 3: HOẠCH ĐỊNH KIỂU DÁNG DI CHUYỂN .1 Giới thiệu chung .2 Dáng di chuyển liên tục .3 Dáng di chuyển không liên tục .1 Dáng di chuyển không liên tục 2 phase .2 Dáng di chuyển không liên tục 4 phase .4 Phƣơng pháp chuyển hƣớng cho robot .1 Đi vòng tròn bán kính R .1 Quay tròn tại chỗ.
35 CHƢƠNG 4: ĐỘNG HỌC VÀ ĐỘNG LỰC HỌC CỦA ROBOT .1 Giới thiệu chung .2 Bài toán động học của robot .1 Động học thuận của robot .2 Động học ngƣợc của robot .3 Động lực học của robot. 42 CHƢƠNG 5: MÔ PHỎNG VÀ THỰC NGHIỆM .1 Mô hình thực nghiệm .1 Kết cấu cơ khí .3 Bộ điều khiển .2 Giao diện chƣơng trình điều khiển .3 Kết quả thực nghiệm của dáng di chuyển liên tục .4 Kết quả thực nghiệm của dáng di chuyển không liên tục .1 Dáng di chuyển 2 phase không liên tục .2 Dáng di chuyển 4 phase không liên tục .5 Xoay tròn tại chỗ .6 Đánh giá kết quả. 71 CHƢƠNG 6: KẾT LUẬN VÀ HƢỚNG PHÁT TRIỂN .1 Những nội dung đạt đƣợc của luận văn .2 Những hạn chế của luận văn.2 Hƣớng phát triển. 73 TÀI LIỆU THAM KHẢO.
Code sử lý ảnh trên Matlab. Code tính động học thuận trên Matlab gui. Code tính động học nghịch trên Matlab gui. Code lập trình vi điều khiển .1 Dáng di chuyển liên tục .2 Dáng di chuyển hai phase không liên tục .3 Dáng di chuyển bốn phase không liên tục .4 Xoay tròn tại chỗ.
98 vii DANH MỤC HÌNH ẢNH Hình 1.1a :Robot Pogostick của Raibert .1b : Hopper robot của Toyota .2a : Wabot-1 tại Đại học Waseda .2b :Wabot-2 tại Đại học Waseda .3 : Lịch sử phát triển Robot Asimo của Honda.5a : Nguyên lý robot di chuyển bằng chân của Chebyshev .5a : Mô hình robot di chuyển bằng chân của Chebyshev .6 : Ngựa cơ khí của LA Rygg đƣợc cấp bằng sáng chế Mỹ năm1893 .6 : Ngựa cơ khí của LA Rygg đƣợc cấp bằng sáng chế Mỹ năm1893 .7 : Ngựa cơ khí của LA Rygg đƣợc cấp bằng sáng chế Mỹ năm1893 .7a :General electric quadruped của R.7b :Robot SCOUT-1 của Buehler .8 :Khả năng di động của robot dạng chân.9 :Vƣợt chƣớng ngại vật của robot dạng chân .10 : Ƣu điểm của hệ thống treo.11 :Ƣu điểm về vƣợt địa hình phức tạp .12 :Khả năng chống trƣợt và chống kẹt của robot dạng chân.1 :Sơ đồ cấu trúc của phƣơng pháp điều khiển có tính toán .2 :Không gian làm việc của các chân robot .3 :Biểu diễn các tập hợp con của dáng di chuyển có trật tự .4 :Biên độ ổn định của robot .1 :Ba ví dụ cho dáng di chuyển của động vật 4 chân .2 :Đồ thị của dáng di chuyển liên tục.3 :Sơ đồ bƣớc chân của dáng di chuyển liên tục.4 :Đồ thị của dáng di chuyển 2 phase không liên tục .5a :Sơ đồ bƣớc chân của dáng di chuyển 2 phase không liên tục (phase 1) .5b :Sơ đồ bƣớc chân của dáng di chuyển 2 phase không liên tục (phase 2) .6 :Đồ thị của dáng di chuyển 4 phase không liên tục .7a :Sơ đồ bƣớc chân của dáng di chuyển 4 phase không liên tục (phase 1) .7b :Sơ đồ bƣớc chân của dáng di chuyển 4 phase không liên tục (phase 2) .7c :Sơ đồ bƣớc chân của dáng di chuyển 4 phase không liên tục (phase 3) .7d :Sơ đồ bƣớc chân của dáng di chuyển 4 phase không liên tục (phase 4) .8 :Quỹ đạo thân Robot khi rẽ .9 :Xoay tròn tại chỗ của dáng di chuyển liên tục .10 :Xoay tròn tại chỗ của dáng di chuyển hai pha không kliên tục .1 :Thông số động học của robot 4 chân .1 :Mô hình lắp ráp robot trên Solidworks .2 :Động cơ RC servo MG 996 .3 :Giản đồ xung kích servo .4 :Sơ đồ chân vi điều khiển DSPic 30F4011 .5 :Mô hình điều khiển robot .6 :Giải thuật điều khiển robot .8 :Giao diện điều khiển robot .9 :Trình tự đi thẳng của dáng đi liên tục .10 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 5.11 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 5.12 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 11.13 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 11.14 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 23.15 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 23.16 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 46.17 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 46.18 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 92.19 :Đồ thị của dáng di chuyển liên tục( độ rộng bƣớc 92.20 :Trình tự đi thẳng của dáng di chuyển 2 phase không liên tục .