Nghiên cứu phương án điều khiển robot scara

TÓM TẮT ĐỒ ÁN TÊN ĐỀ TÀI: NGHIÊN CỨU PHƯƠNG ÁN ĐIỀU KHIỂN ROBOT SCARA Robot SCARA (Selective Compliant Assembly Robot Arm Selective Compliant Articulated Robot Arm) loại robot sử dụng phổ biến công nghiệp, hoạt động ổn định với tốc độ cao nhằm đáp ứng nhu cầu sản xuất tự động hóa thời buổi cơng nghiệp đại Tuy nhiên, Việt Nam việc thiết kế, chế tạo điều khiển Robot SCARA nhiều hạn chế như: vật liệu chế tạo; kỹ thuật lắp ráp; thuật tốn điều khiển tốc độ robot cịn chậm chưa đáp ứng yêu cầu tự động hóa công nghiệp Đề tài tập trung vào việc lập trình điều khiển Robot SCARA, hồn thiện khớp thứ (khớp xoay) đồng thời gắn thêm phễu hút vào đầu cấu làm việc robot dùng để hút bi sắt bỏ vào khuôn, robot hút bi sắt từ khuôn di chuyển bỏ bi sắt vào khuôn với tốc độ cao Hệ thống phễu hút hoạt động nhờ vào hệ thống khí nén Đề tài thực bối cảnh nhóm nghiên cứu Cơ Điện Tử ứng dụng – Bộ môn Cơ Điện Tử thực mục tiêu tiếp cận với robot cơng nghiêp giới Ở đề tài này, nhóm giao nhiệm vụ “Nghiên cứu phương án điều khiển Robot SCARA” Nhằm hướng đến việc điều khiển Robot SCARA chạy với tốc độ cao theo thuật toán điều khiển vị trí, đồng thời hướng đến mục tiêu đưa Robot SCARA vào sản xuất thực tiễn công nghiệp đáp ứng nhu cầu sống Nhóm sinh viên thực v ABSTRACT SUBJECT: RESEARCH PLANS AND CONTROL ROBOT SCARA Robot SCARA (Selective Compliant Assembly Robot Arm Robot Arm or Selective Compliant Articulated) is one type of robot is used very commonly in industry, stable operation with very high speed to meet the demands of production automation in modern industry times However, in Vietnam at present the design, manufacture and SCARA Robot control is still limited, such as manufacturing materials; assembly techniques; the control algorithm of the robot velocity is slow not meet the requirements of industrial automation The theme day focuses on programming control SCARA Robotcomplete the 4th joints (rotary joints) and attach suction hopper on top of the robot working structure to absorb steel balls put into the mold, the robot will suck steel balls from mold moves and put into molds steel balls at high speed Hopper suction system works thanks to the compressed air system This topic is done in the context of the research group Application Mechatronics Mechatronics Division is implementing a targeted approach with base of the world's industry robots On this topic, the group tasked to "Design, manufacture and control SCARA Robot" Aim to control SCARA Robot running at high speed according to the position control algorithm, while aiming to bring into production SCARA Robot practices in the industry to meet the needs of life vi MỤC LỤC Trang NHIỆM VỤ ĐỒ ÁN TỐT NGHIỆP ii LỜI CAM KẾT iii LỜI CẢM ƠN iv TÓM TẮT ĐỒ ÁN v ABSTRACT vi MỤC LỤC vii DANH MỤC BẢNG BIỂU xi DANH MỤC SƠ ĐỒ, HÌNH VẼ xii DANH MỤC TỪ VIẾT TẮT xiv CHƯƠNG GIỚI THIỆU 1.1 Đặt vấn đề 1.2 Định nghĩa giới thiệu Robot SCARA 1.3 Ý nghĩa khoa học thực tiễn đề tài 1.4 Mục tiêu nghiên cứu đề tài 1.5 Giới hạn đề tài 1.6 Phương pháp nghiên cứu 1.7 Một số loại Robot SCARA hãng sản xuất CHƯƠNG TỔNG QUAN VỀ ROBOT 2.1 Sự phát triển robot công nghiệp 2.2 Phân loại robot công nghiệp 2.2.1 Phân loại theo kết cấu 2.2.2 Phân loại theo phương pháp điều khiển 2.2.3 Phân loại theo ứng dụng 2.3 Tình hình nghiên cứu Robot SCARA nước 2.3.1 Phương pháp nghiên cứu 2.3.2 Thành tựu đạt 2.4 Tình hình nghiên cứu Robot SCARA nước 2.4.1 Phương pháp nghiên cứu vii 2.4.2 2.5 Thành tựu đạt 10 Một số ứng dụng thực tế Robot SCARA công nghiệp 10 CHƯƠNG 3.1 CƠ SỞ LÝ THUYẾT 12 Thông số kỹ thuật Robot SCARA 12 3.1.1 Cấu hình Robot SCARA 12 3.1.2 Giới hạn không gian làm việc 13 3.2 Động học Robot 14 3.2.1 Qui tắc Denavit Hartenberg 15 3.2.2 Động học thuận Robot SCARA 16 3.2.3 Động học nghịch Robot SCARA 19 3.2.4 Jacobian 20 3.3 Thiết bị khác Robot SCARA 20 3.3.1 Động DC Servo 21 3.3.2 Các thiết bị khí nén 21 3.3.3 Bi khuôn đựng bi 21 3.3.3.1 Khuôn đựng bi 21 3.3.3.2 Thông số bi thép 23 CHƯƠNG THIẾT KẾ VÀ BỔ SUNG KHỚP THỨ 24 4.1 Giới thiệu chung truyền đai 24 4.1.1 Cấu tạo nguyên lý làm việc truyền đai 24 4.1.2 Ưu nhược điểm phạm vi sử dụng 24 4.2 Lựa chọn động 25 4.2.1 Cấu tạo động 25 4.2.2 Thông số động 25 4.3 Lựa chọn truyền đai 26 4.3.1 Các loại dây đai 26 4.3.2 Kết luận 27 4.4 Tính tốn thơng số truyền đai 27 4.4.1 Các thơng số hình học truyền đai 27 4.4.1.1 Đường kính bánh đai 27 viii 4.4.1.2 Góc ơm 27 4.4.1.3 Chiều dài đai 28 4.4.1.4 Khoảng cách trục 28 4.4.2 4.5 Cơ học truyền động đai 28 4.4.2.1 Chọn loại đai tiết diện đai 28 4.4.2.2 Vận tốc tỉ số truyền 30 4.4.2.3 Phân tích lực tác dụng lên đai 31 4.4.2.4 Ứng suất đai 32 Hình ảnh 3D khớp thứ 32 4.5.1 Bánh đai chủ động 32 4.5.2 Bánh đai bị động 33 4.5.3 Dây đai 33 4.5.4 Giá đỡ động 34 4.5.5 Bộ truyền đai khớp thứ 34 CHƯƠNG 5.1 THI CÔNG ĐIỆN – ĐIỀU KHIỂN VÀ THUẬT TOÁN 36 Thiết kế thi công mạch DC Servo Driver 36 5.1.1 Sơ đồ nguyên lý 36 5.1.2 Mạch in & mô 38 5.1.3 Tính 38 5.2 Thuật toán điều khiển 39 5.2.1 Thuật toán lập trình vi điều khiển 39 5.2.1.1 Điều khiển vị trí 39 5.2.1.2 DC Servo Driver 45 5.2.1.3 Mạch hồi tiếp encoder 49 5.2.2 Giao diện giao tiếp máy tính 53 CHƯƠNG KẾT QUẢ THỰC NGHIỆM, PHÂN TÍCH – TỞNG HỢP 56 6.1 Di chuyển điểm 56 6.2 Di chuyển theo quy trình 63 6.3 Ứng dụng di chuyển bi thép 63 CHƯƠNG KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN 66 ix 7.1 Ưu điểm 66 7.2 Nhược điểm 66 7.3 Hướng phát triển 67 TÀI LIỆU THAM KHẢO 68 PHỤ LỤC A MỘT SỐ MẠCH ĐIỆN TỬ KHÁC 69 PHỤC LỤC B BỘ TRUYỀN HARMONIC GEAR 76 PHỤ LỤC C THIẾT KẾ BỘ ĐIỀU KHIỂN PID 78 x DANH MỤC BẢNG BIỂU Trang Bảng 3.1: Thông số Denavit - Hartenberg 16 Bảng 3.2: Tham số Denavit-Hartenberg Robot SCARA 17 Bảng 3.3: Thông số động 21 Bảng 3.4: Thông số thiết bị khí nén 21 Bảng 4.1: Thông số động DC Servo NC5475E 26 Bảng 4.2: Tra dây đai theo tiêu chuẩn 29 Bảng 5.1: Sơ đồ chân sử dụng lập trình - điều khiển 39 Bảng 5.2: Ý nghĩa chuỗi liệu nhận từ máy tính 42 Bảng 6.1: Bảng tọa độ di chuyển đầu công tác Robot SCARA 63 Bảng 6.2: Bảng tọa độ đáp ứng đầu công tác 64 xi DANH MỤC SƠ ĐỒ, HÌNH VẼ Hình 1.1: Trang Một số loại Robot SCARA hãng Hình 2.1: Robot SCARA Hình 2.2: Mơ hình robot SCARA 10 Hình 3.1: Mơ hình Robot SCARA Solidworks 12 Hình 3.2: Thơng số kích thước Robot SCARA 13 Hình 3.3: Giới hạn làm việc khớp 14 Hình 3.4: Giới hạn làm việc khớp 14 Hình 3.5: Định nghĩa hệ toạ độ thông số Denavit Hartenberg 15 Hình 3.6: Hệ trục đặt Robot SCARA 17 Hình 3.7: Khuôn đựng bị 22 Hình 4.1: Bộ truyền đai 24 Hình 4.2: Động DC servo 25 Hình 4.3: Loại dây đai 26 Hình 4.4: Đai hình lược 27 Hình 4.5: Đồ thị chọn loại dây đai 29 Hình 4.6: Dây đai 160XL 29 Hình 4.7: Biểu đồ ứng suất đai 32 Hình 4.8: Bánh đai chủ động 33 Hình 4.9: Bánh đai bị động 33 Hình 4.10: Dây đai 34 Hình 4.11: Giá đỡ động 34 Hình 4.12: Bộ truyền đai khớp thứ 35 Hình 5.1: Khối Opto 36 Hình 5.2: Khối nguồn 37 Hình 5.3: Khối vi điều khiển 37 Hình 5.4: Khối ngoại vi khác 37 Hình 5.5: Mạch in Driver DC servo 38 Hình 5.6: Mơ mạch Driver 38 xii Hình 5.7: Sơ đồ điều khiển vị trí đầu công tác Robot SCARA 39 Hình 5.8: Lưu đồ tổng quát nhận liệu từ máy vi tính (USART1) 41 Hình 5.9: Thuật toán ngắt nhận USART2 từ mạch hồi tiếp encoder 44 Hình 5.10: Thuật tốn ngắt nhận UART từ ARM driver khớp 46 Hình 5.11: Lưu đồ chương trình DC Servo Driver 47 Hình 5.12: Thuật toán hàm PID 48 Hình 5.13: Lưu đồ PID chia điểm 49 Hình 5.14: Thuật tốn ngắt interrupt - đọc nhiều kênh encoder 50 Hình 5.15: Thuật tốn chương trình mạch hồi tiếp encoder – vẽ đồ thị 51 Hình 5.16: Thuật toán kiểm tra thay đổi encoder khớp 52 Hình 5.17: Thuật tốn chương trình mạch hồi tiếp encoder 53 Hình 5.18: Giao diện điều khiển 54 Hình 5.19: Giao diện vẽ đồ thị 55 Hình 6.1: Đồ thị đáp ứng khớp 60 Hình 6.2: Đồ thị đáp ứng khớp 61 Hình 6.3: Đồ thị đáp ứng khớp 61 Hình 6.4: Đồ thị đáp ứng khớp 62 Hình 6.5: Đồ thị đáp ứng khớp lúc 62 Hình 6.6: Đồ thị đáp ứng di chuyển theo quy trình 63 Hình 6.7: Đồ thị đáp ứng khớp 65 xiii DANH MỤC TỪ VIẾT TẮT CAD Computer Aided Design AFNOR Association Francaise de NORmalisation RIA Robot Institute of America TOCT IR DC Transactions On Computation Theory Industrial Robot Direct Current QEI SCARA Quadrature Encoder Interface Selective Compliance Assembly Robot Arm ARM Selective Compliance Articulated Robot Arm Advanced RISC Machine RISC Reduced Instructions Set Computer UART USART Universal Asynchronous Receiver/Transmitter Universal Synchronous/Asynchronous Receiver/Transmitter xiv Bên cạnh ưu điểm nêu trên, hệ thống tránh nhược điểm cần phải khắc phục Nhằm hoàn thiện robot SCARA đáp ứng tốt chạy với tốc độ cao hơn, hạn chế sau cần phải khắc phục: - Tốc độ di chuyển theo quy trình tự động chậm di chuyển theo quy - trình tay Chưa có hệ thống khôi phục cố điện Hệ thống khơi phục vị trí ban đầu an tồn khớp chưa hoàn thiện 7.3 Hướng phát triển - Nghiên cứu khắc phục nhược điểm: tốc độ chưa cao di chuyển quy - trình tự động, tự động nhớ vị trí điện Lập trình điều khiển vận tốc Robot SCARA, di chuyển theo quỹ đạo - Hoàn chỉnh lại robot SCARA đưa vào thực tế nhằm đáp ứng yêu cầu đặt - Ứng dụng thiết bị vào điều khiển tự động hóa cơng nghiệp 67 TÀI LIỆU THAM KHẢO Tiếng Việt [1] Nguyễn Trường Thịnh (2014), “Giáo trình Kỹ Thuật Robot”, Nhà xuất ĐHQG TpHCM [2] Trịnh Chất – Lê Văn Uyển (2006), “Tính tốn thiết kế hệ dẫn động khí – Tập 1”, Nhà xuất giáo dục [3] Nguyễn Văn Yến, “Giáo trình chi tiết máy”, Nhà xuất giao thông vận tải [4] Nguyễn Hữu Lộc (2008), “Cơ sở thiết kế máy”, Nhà xuất ĐHQG TpHCM [5] Nguyễn Thế Hùng, “Giáo trình lý thuyết điều khiển tự động”, Đại học Sư Phạm Kỹ Thuật TpHCM Tiếng Anh [6] Mark W Spong, Seth Hutchinson, and M Vidyasagar (2004), “Robot Dynamics and Control Second Edition” Nguồn khác [7] Adelhard Beni Rehiara, “Kinematics of AdeptThree Robot Arm”, University of Papua Indonesia [8] “Thiết kế chế tạo hệ thống Tele – Operation sử dụng thiết bị phản hồi lực 3D”, Luận văn tốt nghiệp sinh viên khóa 11, ngành Cơ điện tử, Đại học Sư Phạm Kỹ Thuật TpHCM 68 PHỤ LỤC A MỘT SỐ MẠCH ĐIỆN TỬ KHÁC A.1 Mạch ARM Cortex-M3 STM32F107VCT6 Hình A.1: KIT TRUONGSA-107 Tính năng:  ARM Cortex-M3 STM32F107VCT6(CPU 72MHz, 256KB Flash, 64KRAM, 12Bit A/D-D/A;PWM, CAN, USB OTG, IIC, SPI, UART, Ethernet)  External EEPROM 2Kbit EEPROM(24L02), 16Mbit SPI Flash (AT45DB161D)  2.8” TFT LCD with ADS7843E  Các chân MCU đưa 100% (Quartrant Pin Header)  RS232 ×  CAN2.0 ×  10M/100M Ethernet RJ45 ×  USB2.0 OTG ×1  20 PIN JTAG/ICE (tiêu chuẩn)  User LED ×  User Button ×  SD Slot  Ngõ giao tiếp A/D, D/A  Nguồn VDC Bảng A.1 Sơ đồ chân sử dụng lập trình - điều khiển: STT PIN Chức Loại ngõ ra/ vào 69 PA9 USART1_TX Truyền liệu lên máy tính PA10 USART1_RX Nhận liệu từ máy tính PA2 USART2_TX Truyền liệu cho DC Servo driver PA3 USART2_RX Nhận liệu từ mạch đọc encoder PE8 Digital Output Bật/ tắt mạch DC1 Servo driver PE9 Digital Output Bật/ tắt mạch DC2 Servo driver PE10 Digital Output Bật/ tắt mạch DC3 Servo driver PE11 Digital Output Bật/ tắt mạch DC4 Servo driver PE7 Digital Output Bật/ tắt Relay A2 Mạch hồi tiếp encoder Hình A.2: Mạch hồi tiếp encoder Bảng A.2: Sơ đồ chân sử dụng lập trình - điều khiển: Chức STT PIN Loại ngõ ra/ vào RC6 UART_TX Truyền liệu lên VĐK chủ/ máy tính RC3 Digital Input Nhận xung từ kênh encoder A1 RC4 Digital Input Nhận xung từ kênh encoder A2 RC5 Digital Input Nhận xung từ kênh encoder A3 RD0 Digital Input Nhận xung từ kênh encoder B1 RD1 Digital Input Nhận xung từ kênh encoder B2 RD2 Digital Input Nhận xung từ kênh encoder B3 RA3 Digital Input Nhận xung từ kênh encoder A4 RA4 Digital Input Nhận xung từ kênh encoder B4 A.3 Mạch nguồn 70 Hình A.3: Nguồn xung sử dụng đồ án Sử dụng nguồn xung làm sẵn với mức điện áp: 3.3V, 5V, 12V, 24V Hỗ trợ dòng cao A.4 Mạch relay Hình A.4: Sơ đồ nguyên lý 71 Hình A.5: Mạch Relay A.5 Mạch cầu H A.5.1 Mạch cầu LMD18200 Là module cầu H dùng IC chuyên dụng LMD18200 hãng National cho dòng liên tục 3A, dòng đỉnh 6A Module thiết kế dành cho ứng dụng điều khiển tốc độ vị trí dùng DC Motor (motion control) Hình A.6: Sơ đồ nguyên lý 72 Hình A.7: Mạch cầu LMD18200 Tính năng:  Dịng liên tục 3A  Dòng đỉnh 6A (200 ms)  Điện áp cấp từ +12V tới +55V     Chuyển mạch công suất bên dùng DMOS, cho Rds(ON) = 0.3 Ohm Ngõ vào tương thích với tín hiệu CMOS TTL Có Led báo nguồn cho mạch Bảo vệ ngắn mạch  Board thiết kế nhỏ gọn, kích thước (80x45) mm Hướng dẫn:  PWM (Pulse Width Modulation): nối với kênh PWM card điều khiển, dùng điều khiển tốc độ  DIR: chân điều khiển chiều quay động cơ, nhận tín hiệu nhị phân (H L) từ card điều khiển để thực đảo chiều quay động  BRAKE: chân thắng, nhận tín hiệu từ card điều khiển (H L), cho phép động chạy, dừng, hãm động  TF (THERMAL FLAG OUTPUT): Chân cảnh báo nhiệt  SC (CURRENT SENSE OUTPUT): Chân dòng điện ngõ  M+ M- : kết nối với động  VS GND: nơi cấp nguồn cho mạch A.5.2 Mạch cầu L298 73 Hình A.8: Sơ đồ nguyên lý Hình A.9: Mạch cầu L298 Tính năng:  Driver: L298N tích hợp hai mạch cầu H  Điện áp điều khiển: +5 V ~ +12 V  Dòng tối đa cho cầu H là: 2A  Điện áp tín hiệu điều khiển: +5 V ~ +7 V 74  Dịng tín hiệu điều khiển: ~ 36mA  Cơng suất hao phí: 20W (khi nhiệt độ T = 75 ℃)  Nhiệt độ bảo quản: -25 ℃ ~ +130 ℃  Kích thước: 55mm * 49mm * 33mm  Khối lượng: 33g 75 PHỤC LỤC B BỘ TRUYỀN HARMONIC GEAR Tên gọi gốc truyền harmonic gear Strain Wave Gearing, hãng Harmonic chế tạo độc quyền sản xuất, truyền thường gọi ngắn gọn hộp số Harmonic hay truyền harmonic gear B.1 Nguyên lý hoạt động Hình B.1: Nguyên lý hoạt động Trong có phận gồm: Wave Generator, Flexspline Circular Spline Hình B.2: Bộ phận cấu thành truyền Do số bánh ăn khớp với khác nên đĩa bên chuyển động hộp số có số vịng quay theo chênh lệch số tổng số bánh B.2 Đặc điểm truyền động 76  Nhỏ, gọn, nhẹ  Chạy êm, nhẹ nhàng, rung động tiếng ồn thấp  Tỷ số truyền cao từ 30:1 đến 320:1, với khơng gian truyền bánh hành tinh thông thường đến mức 10:1  Mô-men xoắn cao  Bộ truyền thường sử dụng công nghiệp điều khiển chuyển động, robot, máy in hàng không vũ trụ 77 PHỤ LỤC C THIẾT KẾ BỘ ĐIỀU KHIỂN PID C.1 Giới thiệu Chúng ta thấy tính chất thành phần: khuếch đại (P); tích phân (I); vi phân (D) cách sử dụng để nhận đáp ứng mong muốn Trong phần để cập đến hệ thống có phản hồi đầu ra: Hình C.1: Sơ đồ khối điều khiển Plant: Đối tượng điều khiển Controller: Bộ điều khiển cung cấp tín hiệu điều khiển cho đối tượng điều khiển C.2 Chọn điều chỉnh Theo kinh nghiệm thực tế, người ta thuờng chọn sau: Bộ điều chỉnh P Bộ điều chỉnh P thích hợp cho đối tượng điều khiển ổn định bậc (PT1), bậc (PT2) bậc n đối tượng điều khiển không ổn định Bộ điều chỉnh I Bộ điều chỉnh I thích hợp cho đối tượng điều khiển ổn định bậc (khâu P), bậc (PT1) đối tượng điều khiển có khâu dịch trễ Bộ điều chỉnh PI PID Bộ điều chỉnh PI PID thích hợp cho đối tượng điều khiển ổn định bậc (PT2) bậc n C.2.1 Xác định thông số điều chỉnh Có nhiều phương pháp để xác định thông số tối ưu điều chỉnh PID tiện ích ứng dụng thực tế phương pháp thực nghiệm: Phương pháp Ziegler - Nichols Phương pháp Chien, Hrones Reswick C.2.2 Lựa chọn phương pháp Ziegler - Nichols Ziegler Nichols đưa phương pháp xác định thông số tối ưu PID từ đáp ứng độ đối tượng từ đáp ứng độ hệ kín * Dùng đáp ứng độ đối tượng Phương pháp còn có tên phương pháp thứ Ziegler – Nichols Nó có nhiệm vụ xác định thông số Kp, TN, Tv cho điều chỉnh P, PI PID sở đối tượng mơ tả xấp xỉ khâu bậc có trễ: 78 𝐾𝑒 −𝑇𝑡𝑠 𝑇𝑠 + Sao cho hệ thống nhanh chóng trạng thái xác lập độ vọt lố 𝜎𝑚𝑎𝑥 không vượt G(s) = giới hạn cho phép, khoảng 40% so với h(∞) = lim ℎ(𝑡): 𝑡→∞ 𝜎𝑚𝑎𝑥 = | ℎ𝑚𝑎𝑥 −h(∞) h(∞) | ≤ 40% Ba tham số Tt (thời gian trễ), K (hệ số khuyếch đại) T (hằng số thời gian qn tính) mơ hình xấp xỉ xác định gần từ đồ thị hàm độ h(t) đối tượng Nếu đối tượng có dạng Hình C2.2-a mơ tả từ đồ thị hàm h(t) ta đọc được: Tt khoảng thời gian tín hiệu h(t) chưa có phản ứng với tín hiệu kích thích I(t) đầu vào K giá trị giới hạn: h(∞) = lim ℎ(𝑡) 𝑡→∞ Gọi A điểm kết thúc khoảng thời gian trễ, tức điểm trục hồnh có hồnh độ Tt Khi t khoảng cần thiết sau Tt để tiếp tuyến h(t) A đạt giá trị K Hình C2.2: Xác định tham số cho mơ hình xấp xỉ bậc có trễ Trường hợp hàm q độ h(t) khơng có dạng lý tưởng, có dạng gần giống hình chữ S khâu qn tính bậc bậc n mơ ta Hình C2.2-b ba tham số K, Tt, T xấp xỉ sau: K giá trị giới hạn h(∞) Kẻ đường tiếp tuyến h(t) điểm uốn Khi Tt hồnh độ giao điểm tiếp tuyến với trục hoành T khoảng thời gian cần thiết để đường tiếp tuyến từ giá trị tới giá trị K Như ta thấy điều kiện để áp dụng phương pháp xấp xỉ mơ hình bậc có trễ đối tượng đối tượng phải ổn định, khơng có dao động hàm q độ phải có dạng chữ S Sau có tham số cho mơ hình xấp xỉ của điều chỉnh theo bảng sau: Bảng C.1 Bộ điều chỉnh Kp 79 TN Tv 𝑇 𝐾 Tt P PI 0,9 𝑇 𝐾 Tt _ _ 10 𝑇 𝑡 _ 𝑇 0,5 Tt Tt 𝐾 Tt Từ Bảng C.1 ta xác định thông số khác điều chỉnh sau: PID 1,2 Hệ số tích phân: Ki = 𝐾 𝑇𝑁 Hệ số vi phân: Kd = Kp Tv C.3 Ba tham số điều khiển Hàm truyền điều khiển PID có dạng sau: 𝐾𝐼 𝐾𝐷 𝑠 + K 𝑃 𝑠 + 𝐾𝐼 K 𝑃 + + 𝑠𝐾𝐷 = 𝑠 𝑠 KI: hệ số tích phân KP: hệ số khuếch đại KD: hệ số vi phân Với: Trước tiên xem điều khiển PID hoạt động vịng kín Biến e sai lệch đầu vào mong muốn (R) đầu thực tế (Y) Sai lệch (e) đưa vào điều khiển PID điều khiển PID thực việc lấy đạo hàm tích phân sai lệch (e) 𝑑𝑒 u = K 𝑃 𝑒 + 𝐾𝐼 ∫ 𝑒𝑑𝑡 + 𝐾𝐷 𝑑𝑡 Tín hiệu (u) đưa vào đối tượng điều khiển P ta thu tín hiệu đầu Tín hiệu đầu gửi lại nhờ cảm biến để tính tốn tín hiệu sai lệch Bộ điều khiển lại lấy tín hiệu điều sai lệch để tính tốn tốn lại đạo hàm tích phân chúng Quá trình tiếp tục C.4 Đặc điểm điều khiển P, I D Bộ điều khiển tỉ lệ P giúp giảm thời gian đáp ứng; giảm sai lệch tĩnh không triệt tiêu sai lệch tĩnh Bộ điều khiển tích phân I có khả triệt tiêu sai lệch tĩnh; làm cho đáp ứng độ tồi tệ Bộ điều khiển vi phân D giúp giảm độ điều chỉnh; cải thiện đáp ứng hệ thống, nhiên làm hệ độ ổn định nhạy cảm với nhiễu Các ảnh hưởng điều khiển P, I, D với hệ kín tổng hợp bảng Thời gian dáp ứng Độ điều chỉnh Thời gian độ Sai lệch tĩnh KP Giảm Tăng Ít thay đổi Giảm KI Giảm Tăng Giảm Triệt tiêu 80 KD Ít thay đổi Tăng Giảm Ít thay đổi Chú ý: Những tương quan khơng xác nhiều tình huống, Kp; Ki; Kd phụ thuộc vào Trong thực tế việc thay đổi thông số làm thay đổi ảnh hưởng hai thơng số cịn lại Vì lí này, bảng nên sử dụng tài liệu tham khảo bạn xác định giá trị cho Ki, Kp, Kd Nhận xét:  Nếu sử dụng riêng thành phần Kp sai số xác lập e(∞) tồn (≠0) Tăng Kp làm tăng tốc độ đáp ứng hệ kín, giảm thời gian độ sai số xác lập lại làm tăng tính dao động hệ (tăng độ vọt lố) Với đối tượng có bậc hàm truyền > bậc Kp tăng cao, hệ thống ổn định  Nếu sử dụng thêm thành phần Ki phạm vi hệ thống ổn định, sai số xác lập e(∞) Tăng Ki làm tăng tốc độ đáp ứng hệ kín, giảm thời gian độ lại làm tăng độ vọt lố Khi Ki tăng giới hạn, hệ thống ổn định  Thành phần Kd có tác dụng làm giảm dao động, giảm độ vọt lố không ảnh hưởng đến sai số xác lập hệ thống Tín hiệu thành phần Kd tỉ lệ với đạo hàm e(t) nên tác dụng hiệu chỉnh chủ yếu giai đoạn đầu đáp ứng độ  Phối hợp ba thành phần Kp, Ki, Kd với giá trị lựa chọn thích hợp, ta hiệu chỉnh để hệ thống ổn định, sai số e(∞)=0, thời gian độ vọt lố đạt yêu cầu mong muốn 81 ... vị trí Robot SCARA Phạm vi nghiên cứu  Nghiên cứu ứng dụng thuật toán điều khiển Robot SCARA  Điều khiển vị trí Robot khảo sát đáp ứng 1.6 Phương pháp nghiên cứu Nhóm tiến hành nghiên cứu thiết... tập nghiên cứu lĩnh vực Robot cơng nghiệp nhóm chọn đề tài ? ?Nghiên cứu phương án điều khiển Robot SCARA? ?? với mục tiêu:  Tham gia nghiên cứu ứng dụng lĩnh vực Robot công nghiệp  Nghiên cứu. .. kế robot Lĩnh vực điều khiển robot phong phú, từ phương pháp điều khiển truyền thống PID, phương pháp tính mơ-men, phương pháp điều khiển trượt đến phương pháp điều khiển thông minh như: điều khiển