iii LỜI CAM ĐOAN Tôi xin cam đoan đây là công trình nghiên cứu của riêng tôi và thầy hƣớng dẫn. Các số liệu, kết quả nêu trong Luận văn là trung thực và chƣa từng đƣợc ai công bố trong bất kỳ công trình nào khác. Tôi xin cam đoan rằng mọi sự giúp đỡ cho việc thực hiện Luận văn này đã đƣợc cảm ơn và các thông tin trích dẫn trong Luận văn đã đƣợc chỉ rõ nguồn gốc. Học viên thực hiện Luận văn Lê Văn Phúc iv LỜI CẢM ƠN Lời đầu tiên em xin gửi lời cám ơn chân thành đến Thầy TS.
Nguyễn Duy Anh đã tận tình hƣớng dẫn em về chuyên môn và kinh nghiệm để giúp em thực hiện luận văn tốt nghiệp. Tiếp theo em xin gửi lời cảm ơn chân thành và sâu sắc đến quý thầy giảng viên Trƣờng Đại học Công Nghệ Tp.HCM và Trƣờng Đại học Bách Khoa Tp.HCM đã nhiệt tình giảng dạy, truyền đạt những kiến thức và kinh nghiệm quý báu cho chúng em trong quá trình giảng dạy khóa cao học tại trƣờng Đại học Công Nghệ Tp. Em rất biết ơn sự giúp đỡ của gia đình, bạn bè và đồng nghiệp đã giúp đỡ, động viên và ở bên cạnh em trong suốt quá trình học và làm luận văn tốt nghiệp. Em cũng xin gửi lời cám ơn đến các anh/chị, các bạn học viên đã giúp đỡ, cùng trau dồi kiến thức trong suốt quá trình học tập và làm luận văn tốt nghiệp.
Lê Văn Phúc v TÓM TẮT NỘI DUNG LUẬN VĂN Trong quá trình công nghiệp hóa hiện nay, việc khử rơ cho các bộ truyền động trong cơ khí là hết sức quan trọng. Làm thế nào để khử rơ trong truyền động ? Việc thiết kế bộ điều khiển khử rơ trong truyền động cơ khí là hết sức quan trọng và cần thiết trong điều khiển hiện nay. Luận văn sẽ thiết kế bộ điều khiển khử rơ cho kết cấu truyền động cơ khí. Mục đích của luận văn là phân tích, thiết kế và mô phỏng bộ điều khiển khả thi cho hệ thống.
Các phƣơng án khử rơ: Khử rơ bằng cách hiệu chỉnh thiết kế cơ khí của hệ truyền động hoặc điều chỉnh hành trình, và khử rơ bằng giải thuật điều khiển. Thực nghiệm hiệu chỉnh bộ điều khiển trên hệ servo driving mechanism. Sau khi có đƣợc sai lệch của từng khâu, tiến hành áp dụng bộ khử rơ ngƣợc. Ở phần trên cung cấp các bộ điều khiển khử rơ khác nhau, chất lƣợng các bộ điều khiển khử rơ này tùy theo hệ thống mà có sự phù hợp.
Bộ điều khiển khử rơ vòng hở đƣợc áp dụng cho hệ thống vòng hở không có hồi tiếp, bộ điều khiển vòng kín PID đƣợc áp dụng cho hệ thống có hồi tiếp nhƣng thông số hàm truyền không thay đổi.Trong khi đó bộ điều khiển thích nghi đƣợc áp dụng cho hệ thống có thông số thay đổi. vi ABSTRACT In the age of industrialization, the important problem is de-trailers of mechanical actuators. How can we do it ? Today, the vital and necessary thing is that we have to design a control panel in order to reduce trailers in processing. This thesis will be analyzed, designed and simulated a control panel of backlash in mechanical actuators.
The methods to re-trailers: meachinal design adjustment of tranmission or stoke adjustment, and control algorithm. The empirical calibration with controller on servo driving mechanism driving mechanism. After acquiring deviations of each stage, proceed to apply the reverse de-trailers. The controllers offer different de-trailers, the quality of controllers depend on certain system, the open controller de-trailers loop is applied to the open-loop system without feedback, closed-loop PID controller is applied to the system.
However, the feedback transfer function parameters do not change, while the adaptive controller is applied to the system parameters change. vii MỤC LỤC Chƣơng 1: TỔNG QUAN. Giới thiệu chung. Các phƣơng án khử rơ.
Khử rơ bằng cách hiệu chỉnh thiết kế cơ khí hoặc điều chỉnh hành trình. Khử rơ bằng giải thuật điều khiển:. Tính cấp thiết của đề tài. Tổng quan về lĩnh vực nghiên cứu.
Tình hình nghiên cứu trên thế giới. Tình hình nghiên cứu trong nƣớc. Mục tiêu và nội dung nghiên cứu của đề tài .7 Chƣơng 2: PHÂN TÍCH, THIẾT KẾ BỘ ĐIỀU KHIỂN KHẢ THI CHO HỆ THỐNG. Phân tích thiết kế bộ điều khiển.
Hàm rơ, hàm rơ ngƣợc và phƣơng pháp xác định hàm rơ. Thiết kế hệ thống điều khiển. Điều khiển đáp ứng .17 Chƣơng 3: NHẬN DẠNG HỆ THỐNG VÀ MÔ PHỎNG. Nhận dạng hệ thống.
Mô phỏng nhận dạng hệ thống. Mô phỏng bộ điều khiển thích nghi. MRAS sử dụng luật MIT cho hệ bậc 2. Mô hình hóa hệ thống tổng hợp:.
30 Chƣơng 4: THỰC NGHIỆM TRÊN HỆ CHUYỂN ĐỘNG TUYẾN TÍNH. Hệ thống điều khiển thực nghiệm. Điều khiển trên máy tính. Điều khiển trên vi điều khiển.
Vấn đề truy nhập bộ nhớ trực tiếp DMA. Thực nghiệm hệ servo driving mechanism. Nhận dạng hệ thống. Áp dụng các bộ điều khiển thực nghiệm.
Đánh giá kết quả của hệ thống điều khiển. 60 Chƣơng 5: KẾT QUẢ VÀ THẢO LUẬN. Kết quả thực nghiệm khử rơ và thảo luận.63 Phụ lục A: THIẾT KẾ MÔ HÌNH THÍ NGHIỆM .64 Phụ lục B: KẾT QUẢ THÍ NGHIỆM .74 ix DANH MỤC CÁC TỪ VIẾT TẮT CNC: Computer(ized) Numerical(ly) Control(led) MIT: Massachusetts Institute of Technology PID: Proportional Integral Derivative DANH MỤC CÁC BẢNG Bảng 1: .66 x DANH MỤC CÁC HÌNH Hình 2.1 Mô hình giải thuật điều khiển của đề tài .2 Đồ thị và ví dụ minh họa về hàm rơ.3 Đồ thị hàm rơ ngƣợc .4 Đồ thị hàm Backlash Inverse hiệu chỉnh .5 Mô hình cơ bản của hệ thống .6 Trình tự thiết kế giải thuật.7 Hệ thống cơ bản .8 Tính toán hình học để xác định thông số độ rơ .9 Hệ thống đƣợc khử rơ bằng hàm rơ ngƣợc .10 Mô hình điều khiển thích nghi theo mô hình tham chiếu .1 Các bƣớc nhận dạng hệ thống .2 Đồ thị đáp ứng hệ thống khi không có rơ và khi có rơ .3 Đồ thị đáp ứng hệ thống khi không có rơ và khi có rơ .5 Đồ thị nhận dạng hàm truyền .7 Kết quả mô phỏng của MRAS hiệu chỉnh bởi luật MIT .8 Kết quả mô phỏng của MRAS hiệu chỉnh bởi luật MIT .9 Sai số trong quỹ đạo điều khiển .10 Quỹ đạo từng trục X và Y .11 Kết quả mô phỏng của MRAS hiệu chỉnh bởi luật MIT .12 Sai số trong quỹ đạo điều khiển .13 Quỹ đạo từng trục X và Y .1 Sơ đồ đồ khối hệ thống thực nghiệm .2 Sơ đồ xung thời gian .3 Mô hình lập trình song song chia sẻ bộ nhớ .4 Giao diện điều khiển chƣơng trình .5 Sơ đồ khối lập trình song song .6 Frame truyền dữ liệu từ máy tính xuống.8 Tín hiệu điều khiển mong muốn và tín hiệu ra có tác động của độ rơ.9 Sai số giữa tín hiệu mong muốn và tín hiệu ra có tác động của độ rơ .10 Tín hiệu điều khiển mong muốn và tín hiệu ra với bộ bù rơ .11 Sai số tín hiệu điều khiển mong muốn và tín hiệu ra với bộ bù rơ .12 Các giai đoạn của quá trình khử rơ .13 Tín hiệu điều khiển mong muốn và tín hiệu ra bằng cách bù xung .14 Sai số tín hiệu điều khiển mong muốn và tín hiệu ra bằng cách bù xung .15 Tín hiệu ra bám theo tín hiệu vào nhƣng dao có sự dao động lớn .16 Tín hiệu điều khiển mong muốn và tín hiệu ra với bộ điều khiển PID không khử rơ .17 Sai số tín hiệu điều khiển mong muốn và tín hiệu ra với bộ điều khiển PID không khử rơ tính hiện tƣợng trễ .18 Sai số tín hiệu điều khiển mong muốn và tín hiệu ra với bộ điều khiển PID không khử rơ, bỏ qua hiện tƣợng trễ .19 Tín hiệu điều khiển mong muốn và tín hiệu ra với bộ điều khiển PID không khử rơ kết hợp bộ điều khiển khử rơ .20 Sai số tín hiệu điều khiển mong muốn và tín hiệu ra với bộ điều khiển PID kết hợp khử rơ .21 Sai số tín hiệu điều khiển mong muốn và tín hiệu ra với bộ điều khiển PID kết hợp khử rơ, bỏ qua hiện tƣợng trễ .22 Tín hiệu ra với bộ điều khiển PID không có khử rơ và kết hợp khử rơ .23 Đầu ra so với tín hiệu mong muốn của các bộ điều khiển khi đảo chiều .24 Sai số bộ điều khiển thích nghi .2 Mô hình tính lực .3 Mô hình hệ chuyển động tịnh tiến .4 Bố trí quá trình thực nghiệm .1 Khử rơ ngƣợc độ rơ 0.2 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 0.185mm thời gian thực .3 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 0.185mm bỏ qua độ trễ .4 Điều khiển đáp ứng độ rơ 0.185mm thời gian thực .5 Điều khiển đáp ứng độ rơ 0.185mm bỏ qua độ trễ .6 Khử rơ ngƣợc độ rơ 0.7 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 0.547mm thời gian thực .8 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 0.547 mm bỏ qua độ trễ .9 Điều khiển đáp ứng độ rơ 0.547 mm thời gian thực .10 Điều khiển đáp ứng độ rơ 0.547mm bỏ qua độ trễ .11 Khử rơ ngƣợc độ rơ 1.12 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 1.180 mm thời gian thực .13 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 1.180 mm bỏ qua độ trễ .14 Điều khiển đáp ứng độ rơ 1.180 mm thời gian thực .15 Điều khiển đáp ứng độ rơ 1.180 mm bỏ qua độ trễ .16 Khử rơ ngƣợc độ rơ 1.17 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 1.665mm thời gian thực .18 Khử rơ PID kết hợp bù rơ ngƣợc độ rơ 1.665mm bỏ qua độ trễ .19 Điều khiển đáp ứng độ rơ 1.665 mm thời gian thực .20 Điều khiển đáp ứng độ rơ 1.665 mm bỏ qua độ trễ .80 1 Chƣơng 1: TỔNG QUAN 1. Giới thiệu chung Trong tất cả chuyển động của các thiết bị máy móc, của các bộ truyền động cơ khí.
Độ rơ là một vấn đề tồn tại trong hệ truyền động cơ khí, ảnh hƣởng rất lớn đến cách toán điều khiển vị trí và vận tốc của các hệ thống trong công nghiệp, robot, xe ô- tô và các ứng dụng điều khiển khác. Có rất nhiều nghiên cứu về độ rơ đã đƣợc thực hiện từ năm 1940. Đây là bài toán rất phức tạp, đặc biệt là khi có yêu cầu độ chính xác cao. Độ rơ xuất hiện khi có khe hở trong cơ cấu truyền động, gây ra nhiễu khi truyền động, đặc biệt khi có sự đảo chiều của vận tốc tƣơng đối giữa các khâu.