Chương 1 TỔNG QUAN .1 Giới thiệu tổng quan .2 Khảo sát đường ống và lựa chọn phương án xây dựng mô hình Pipeline robot .2 Khảo sát đường ống .1 Khó khăn về mặt cơ khí .2 Khó khăn về mặt điện .3 Khó khăn về ứng dụng .3 Một số robot đường ống được giới thiệu trong và ngoài nước .4 Giải pháp thiết kế Pipeline robot .3 Mục đích nghiên cứu .4 Đối tượng nghiên cứu.5 Phạm vi nghiên cứu .6 Phương pháp nghiên cứu .7 Kế hoạch thực hiện .8 Giá trị thực tiễn của đề tài .9 Phác thảo nội dung luận văn. 15 Chương 2 CƠ SỞ LÝ THUYẾT. Điều khiển mờ .2 Khái niệm cơ bản .1 Định nghĩa tập mờ .2 Các thuật ngữ trong logic mờ .3 Biến ngôn ngữ .4 Các phép toán trên tập mờ.5 Luật hợp thành .1 Mệnh đề hợp thành .2 Luật hợp thành mờ .1 Phương pháp cực đại. Phương pháp trọng tâm .3 Bộ điều khiển mờ .1 Cấu trúc một bộ điều khiển mờ .2 Nguyên lý điều khiển mờ .3 Phân loại bộ điều khiển mờ .4 Thiết kế bộ điều khiển mờ.Thiết kế bộ điều khiển PID mờ .1 Sơ đồ điều khiển sử dụng bộ điều khiển PID mờ .2 Luật chỉnh định PID .5 Hệ điều khiển mờ lai.
32 Chương 3 XÂY DỰNG MÔ HÌNH ĐIỀU KHIỂN .1 Thiết kế bộ điều khiển động cơ DC trong Pipeline robot .1 Xây dựng phương trình động cơ DC .2 Yêu cầu điều khiển – Thông số của động cơ .2 Thiết kế bộ điều khỉển PID kinh điển điều khiển động cơ DC .1 Đặc tính điều khiển với bộ PID .2 Hiệu chỉnh thông số của bộ điều khiển PID.3 Sơ đồ điều khiển PID kinh điển điều khiển tốc độ động cơ DC .4 Mô phỏng quá trình điều khiển PID kinh điển động cơ DC .3 Thiết kế bộ điều khiển PID mờ điều khiển động cơ DC .1 Thiết kế bộ điều khiển mờ PID mờ để chỉnh định tham số động cơ DC .2 Sơ đồ điều khiển PID mờ điều khiển động cơ DC .1 Sơ đồ điều khiển PID mờ điều khiển tốc độ động cơ DC .2 Sơ đồ điều khiển PID mờ điều khiển moment động cơ DC .3 Mô phỏng quá trình điều khiển PID mờ cho động cơ DC .4 Thiết kế PID mờ lai cho hệ thống điều khiển động cơ DC .1 Thiết kế bộ điều khiển mờ PID mờ lai điều khiển động cơ DC .2 Sơ đồ điều khiển PID mờ lai điều khiển động cơ DC .1 Sơ đồ điều khiển PID mờ lai điều khiển tốc độ động cơ DC .2 Sơ đồ điều khiển PID mờ lai điều khiển moment động cơ DC .3 Mô phỏng quá trình điều khiển PID mờ lai cho động cơ DC. 53 Chương 4 SƠ ĐỒ VÀ KẾT QUẢ MÔ PHỎNG. Sơ đồ và kết quả mô phỏng hệ thống điều khiển động cơ DC dùng bộ điều khiển PID kinh điển .1 Sơ đồ và kết quả mô phỏng hệ thống điều khiển tốc độ động cơ DC dùng bộ điều khiển PID kinh điển.2 Sơ đồ và kết quả mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID kinh điển.2 Sơ đồ và kết quả mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ .3 Sơ đồ và kết quả mô phỏng hệ thống điều khiển động cơ DC dùng bộ điều khiển PID mờ lai .1 Sơ đồ và kết quả mô phỏng hệ thống điều khiển tốc độ động cơ DC dùng bộ điều khiển PID mờ lai .2 Sơ đồ và kết quả mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai. 79 Chương 5 THIẾT KẾ THI CÔNG MÔ HÌNH PIPELINE ROBOT .1 Thiết kế mô hình Pipeline robot.
Giới thiệu sơ lược về cấu tạo cơ khí .2 Chọn vật liệu cho robot .3 Cơ chế co dãn của chân robot .2 Kích thước của robot .Phân tích hình học của đoạn cong trong đường ống .2 Phân tích hình học của nhánh. Cơ cấu truyền động của robot .Tính toán trục .5 Tính toán thiết kế và nguyên lý hoạt động của các mạch điện .2 Mạch vi điều khiển .3 Mạch LCD, buzzer, buttons .4 Mạch thu phát RF .5 Mạch điều khiển công suất động cơ. Tính toán thiết kế. Mạch động lực đảo chiều động cơ (các mạch kích relay).
Mạch điều xung PWM. Mô hình thổng thể của Pipeline robot. 113 Chương 6 KẾT LUẬN. 114 TÀI LIỆU THAM KHẢO.
118 v Luan van DANH SÁCH CHỮ VIẾT TẮT/ KÝ HIỆU KHOA HỌC Các từ viết tắt SISO Single Input, Single Output MISO Multi Input, Single Output MATLAB Matrix Laboratory BĐK Bộ điều khiển PI Proportional Integral PD Proportional Derivative PID Proportional Integral Derivative MCFC Điều khiển Mamdani SMFC Điều khiển mờ trượt CMFC Điều khiển tra bảng TSFC Điều khiển Tagaki/Sugeno FLC Fuzzy logic controller DC Direct current NB Negative big NM Negative Medium NS Negative small ZE Zero PS Positive small PM Positive medium vi Luan van PB Positive big I/O Input/output Ký hiệu F Hàm thuộc B Tập nền. KP Độ lợi của khâu tỉ lệ (Proportional gain) KI Độ lợi của khâu tích phân (Integral gain) KD Độ lợi của khâu vi phân (Derivative gain) M Moment Mt Moment tải Kc Hệ số khuyếch đại Ku Hệ số khuyếch đại tới hạn Tu Chu kỳ dao động tới hạn R Điện trở phần ứng [] L Điện cảm phần ứng [H] K Hằng số mômen [Nm/A] V Điện áp phần ứng [V] J Moment quán tính của rotor [kgm2] b Hệ số ma sát cơ [Nms] vi Luan van e(t), ET Sai số Δe(t), DET Độ thay đổi của sai số l Chiều dài θ Góc gấp của liên kết đo bằng chiết áp quay K Độ co dãn h Kích thước từ thân đến bánh xe của robot Fw Lực ép, Ax, Ay Lực tác dụng vào cơ chế co dãn X Độ dời của vít me Mx Moment xoắn trên trục F2 Lực vòng Fr2 Lực hướng tâm Fa2 Lực dọc trục F3 Lực vòng Fr3 Lực hướng tâm Fa3 Lực dọc trục M u(I I ) Moment uốn ở tiết diện I-I M u ( II II ) Moment uốn ở tiết diện II-II d Đường kính trục Mtd Moment tương đương N Hệ số an toàn a Ứng suất pháp (uốn) vi Luan van a Ứng suất tiếp (xoắn) -1 Giới hạn mỏi uốn 1 Giới hạn mỏi xoắn , Hệ số ảnh hưởng của trị số ứng suất trung bình đến sức bền mỏi vi Luan van DANH SÁCH CÁC HÌNH HÌNH TRANG Hình 1.1: Đường ống dẫn dầu hoặc nước.2: Đường ống dẫn khí Ethanol.3: Đường ống dẫn khí Hydrogen.4: Đường ống dẫn nước tước tiêu và nước thải.5: Các vấn đề có thể xảy ra đối với đường ống .6: Robot kiểm tra hệ thống cống .7: Robot vệ sinh đường ống nước thải .8: a)Robot đường ống và b)Hệ thống Robot quét bụi.9: Cấu tạo robot đường ống dạng nhiều khối liên kết .10: Tổng thể của robot đường ống chuyển động xoắn.11: Robot di chuyển trong ống.12: Một dạng của heli-pipe robot.13: Robot dạng xe .14: Robot đường ống kiểu 3 chân linh hoạt .1: Miền và độ cao của tập mờ.2: Các dạng hàm thuộc (membership function) trong logic mờ.3: Phương pháp cực đại ( độ cao H, khoảng G). 22 vii Luan van Hình 2.4: Phương pháp trọng tâm vùng giới hạn bởi hình thang.5: Sơ đồ khối bộ điều khiển mờ.6: Sơ đồ bộ điều khiển mờ.7: Sơ đồ nguyên lý bộ điều khiển mờ.8 a, b, c: Các bộ điều khiển mờ .9: Sơ đồ điều khiển sử dụng PID mờ.10: Vùng tín hiệu cần chỉnh định.11:Nguyên lý điều khiển mờ lai.1: Sơ đồ mạch điện của động cơ DC.2: Sơ đồ khối của động cơ DC.3: Sơ đồ khối hệ điều khiển PID.4: Xác định hằng số khuếch đại tới hạn.5: Sơ đồ điều khiển PID kinh điển điều khiển tốc độ động cơ DC.6: Hàm thuộc ngõ vào của e(t) và e’(t).7: Hàm thuộc ngõ ra của OUT .8 a, b: Quan hệ vào ra của bộ điều khiển mờ.9: Sơ đồ điều khiển PID mờ điều khiển tốc độ động cơ DC .10: Sơ đồ của khối Fuzzy Logic Controller trong hình 3.11: Sơ đồ của khối DC_Motor trong hình 3.12: Sơ đồ điều khiển PID mờ điều khiển moment động cơ DC.13: Sơ đồ của khối Fuzzy Logic Controller trong hình 3. 47 vii Luan van Hình 3.14: Sơ đồ của khối DC_Motor trong hình 3.15: Hàm thuộc ngõ vào của e(t) và e’(t) .16: Hàm thuộc ngõ ra của KP , KD , .17: Quan hệ vào – ra của bộ điều khiển PID mờ lai .18: Sơ đồ mô phỏng hệ thống điều khiển tốc độ động cơ DC dùng bộ điều khiển PID mờ lai .19: Sơ đồ mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai .1: Sơ đồ hệ thống điều khiển tốc độ động cơ DC dùng bộ điều khiển PID kinh điển .2: Sơ đồ hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID kinh điển .3: Sơ đồ điều khiển PID mờ điều khiển tốc độ động cơ DC .4: Sơ đồ điều khiển PID mờ điều khiển moment động cơ DC .19: Sơ đồ mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai .19: Sơ đồ mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai .19: Sơ đồ mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai .19: Sơ đồ mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai .19: Sơ đồ mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai.
54 vii Luan van Hình 4.1: Sơ đồ hệ thống điều khiển tốc độ động cơ DC dùng bộ điều khiển PID kinh điển .2: Sơ đồ hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID kinh điển .3: Sơ đồ điều khiển PID mờ điều khiển tốc độ động cơ DC .4: Sơ đồ điều khiển PID mờ điều khiển moment động cơ DC .5: Sơ đồ hệ thống điều khiển tốc độ động cơ DC dùng bộ điều khiển PID mờ lai .6: Sơ đồ mô phỏng hệ thống điều khiển moment động cơ DC dùng bộ điều khiển PID mờ lai khi ngõ vào là hàm bước, moment tải Mc=0 .1: Cấu tạo cơ khí pipeline robot.2: Cấu tạo phần thân pipeline robot.3: Cơ cấu co duỗi của các chân của pipeline robot.4: Các bánh xe của pipeline robot.5: Cấu tạo phần chân pipeline robot.6: Cơ cấu truyền động của pipeline robot.7: Cấu tạo hình học của đoạn cong trong đường ống.8: Cấu tạo hình học của nhánh trong đường ống.9: Cơ cấu truyền bằng bộ truyền bánh răng côn, bánh răng trụ răng thẳng.10: Moment ở 2 tiết diện I-I và II-II.11: Sơ đồ nguyên lý mạch nguồn Vi điều khiển của Robot. 104 vii Luan van Hình 5.12: Sơ đồ nguyên lý mạch nguồn công suất động cơ & kích relay.13: Mạch vi điều khiển trên Robot.