- Việc áp dụng lô-gic mờ đã cho tạo ra các bộ điều khiển mờ, mờ lai, ... với những tính chất khá tốt nhằm đáp ứng yêu cầu trong điều khiển tự động, ví dụ điều khiển các đối tượng phức tạp. Ngoài ra, các bộ điều khiển mờ cho phép lặp lại các tính chất của các bộ điều khiển kinh điển. Việc thiết kế bộ điều khiển mờ cũng rất đa dạng, qua việc tổ chức các nguyên tắc điều khiển và chọn tập mờ cho các biến ngôn ngữ cho phép người ta thiết kế các bộ điều khiển mờ khác nhau.
- Khối lượng công việc cần thực hiện khi thiết kế một bộ điều khiển mờ không phụ thuộc vào đặc tính của đối tượng. Điều này có nghĩa là quá trình xử lý của một bộ điều khiển mờ với những nguyên tắc điều khiển cho các đối tượng có đặc tính động học khác nhau là hoàn toàn như nhau.
- Khi cánh tay máy chuyển động theo quỹ đạo, ta chọn vị trí ban đầu phải thích hợp để cơ cấu không sinh ra lực cản lớn, momen cản lớn.
Luận văn thạc sĩ kỹ thuật 107 Chuyên ngành: Tự động hóa
- Sai lệch tốc độ trong quá trình chuyển động của cánh tay Robot so với tốc độ của quỹ đạo đặt là tốt (gần bằng 0) so với khi dùng bộ PID. Biên độ dao động tại các thời điểm quá độ và sai lệch quỹ đạo được giảm.
- Khi chọn các tập giá trị mờ và luật điều khiển thích hợp thì luật điều khiển mờ giúp cho hệ đạt được độ chính xác khá cao, ngay cả với giá trị đặt rất nhỏ.
- Hệ thống mô phỏng đã được xét các trường hợp cánh tay Robot mang các phụ tải khác nhau, điều đó càng chứng tỏ tính bền vững cao của hệ điều khiển.
Như vậy hệ thống làm việc ở chế độ không tải hoặc có tải, bộ điều khiển mờ chỉnh định tham số bộ PID đảm bảo được chất lượng tĩnh và động tốt hơn khi dùng bộ điều khiển PID kinh điển.
Luận văn thạc sĩ kỹ thuật 108 Chuyên ngành: Tự động hóa
CHƯƠNG 4
TÍCH HỢP BỘ ĐIỀU KHIỂN MỜ VÀO PLC S7 300 4.1. Phương pháp tích hợp bộ điều khiển mờ vào PLC S7 300 4.1.1. Chương trình phần mềm tích hợp FCPA
4.1.1.1. Chuẩn bị một Project khai báo bộ điều khiển mờ bằng FCPA
Chương trình FCPA (Fuzzy Control Parameter Assignment) là phần mềm hỗ trợ việc tạo lập bộ điều khiển mờ cho PLC Simatic S7-300. Nó được tích hợp vào PLC S7-300 để điều khiển đối tượng theo trình tự các bước như sau:
• Định nghĩa tất cả các biến ngôn ngữ vào/ra • Định nghĩa tập mờ cho các biến vào/ra • Xây dựng luật điều khiển
• Chọn động cơ suy diễn • Chọn phương pháp giải mờ
Bộ điều khiển mờ được tổng hợp với FCPA có dạng một khối dữ liệu (DB). Khối DB được tạo ra bởi FCPA được gọi là khối DB mờ và được sử dụng cùng với FB Fuzzy Control có trong Project FuzConEx khi cài đặt chương trình Fuzzy/FB với tên mặc định là FB30.
4.1.1.2. Khai báo các biến vào ra và viết chương trình
Khởi động chương trình vào menu chọn New/ xuất hiện cửa sổ chọn số lượng biến ngôn ngữ vào/ra cho cho bộ điều khiển mờ thiết kế
Đối với bộ điều khiển mờ ta thiết kế thì chọn 2 vào, 2 ra như hình 4.1
Sau đó ta soạn thảo các luật hợp thành cho bộ điều khiển mờ như hình 4.2
Luận văn thạc sĩ kỹ thuật 109 Chuyên ngành: Tự động hóa
Hình 4.1: Chọn biến ngôn ngữ vào/ ra
Hình 4.2: Cửa sổ soạn thảo biến ngôn ngữ vào/ ra và luật hợp thành Miền giá trị của biến đầu vào (sai lệch ) được chọn là:
et1 = {-3,14 3,14}; (đơn vị tính: rad)
et2 = {-3,14 3,14}; (đơn vị tính: rad) Ta chọn 7 tập giá trị ngôn ngữ như sau:
et = {âm nhiều, âm vừa, âm ít , không, dương ít, dương vừa, dương nhiều} et1 = { NB, NM, NS, ZE, PS, PM, PB}.
et2 = { NB, NM, NS, ZE, PS, PM, PB}.
Miền giá trị của biến đầu vào đạo hàm của sai lệch det được chọn là: det1 = et1 = {-3.14, 3.14} (đơn vị tính: rad/s) det2 = et2 = {-3.14, 3.14} (đơn vị tính: rad/s)
Ta cũng chọn 7 tập giá trị ngôn ngữ như trên, ta viết lại tập giá trị ngôn ngữ của biến sai lệch vị trị det cho hai khớp như sau:
Biến ngôn ngữ đầu vào Biến ngôn ngữ đầu ra Luật hợp thành
Luận văn thạc sĩ kỹ thuật 110 Chuyên ngành: Tự động hóa
det1 = { NB, NM, NS, ZE, PS, PM, PB}. det2 = { NB, NM, NS, ZE, PS, PM, PB}.
Miền giá trị của biến đầu ra HesoHesokp và HesoHesokd được chuẩn hóa là:
Hesokp = Hesokd = {0, 1}
Ta chọn 4 tập giá trị ngôn ngữ như sau: {nhỏ , nhỏ vừa, vừa , lớn}. Với ký hiệu: S = nhỏ, MS = nhỏ vừa, M = vừa, B = lớn, ta viết lại tập giá trị ngôn ngữ của biến sai lệch vị trị et cho hai khớp như sau:
Hesokp = { S, MS, M, B }. Hesokd = { S, MS, M, B }.
Luận văn thạc sĩ kỹ thuật 111 Chuyên ngành: Tự động hóa
Hình 4.4: Cửa sổ soạn thảo các hàm liên thuộc của đầu vào det1
Luận văn thạc sĩ kỹ thuật 112 Chuyên ngành: Tự động hóa
Hình 4.6: Cửa sổ soạn thảo các hàm liên thuộc của đầu ra HesoKD1
Hình 4.7: Màn hình soạn thảo luật điều khiển Trong này ta soạn 49 luật điều khiển cho hai hệ số KP và KD
Luận văn thạc sĩ kỹ thuật 113 Chuyên ngành: Tự động hóa
Hình 4.8: Bảng ma trận luật điều khiển của hệ số KP1
Luận văn thạc sĩ kỹ thuật 114 Chuyên ngành: Tự động hóa
Hình 4.10: Quan hệ vào/ra của bộ điều khiển mờ dạng hình khối (HesoKP1)
Luận văn thạc sĩ kỹ thuật 115 Chuyên ngành: Tự động hóa
4.2. Tiến hành tích hợp bộ điều khiển mờ vào PLC
Sau khi đã thiết kế xong bộ điều khiển mờ ta download vào CPU của PLC thông qua chương trình SIMATIC V5.4 trong đó có các khối chức năng như OB100, OB35, FB30... như hình 4.12. Mỗi khối có một chức năng khác nhau và tuân theo quy tắc bộ điều khiển mờ, các thông số đầu vào ra được yêu cầu theo quy luật điều khiển mờ và bất kỳ ngõ vào ra không sử dụng thì không kết nối trong chương trình
Hình 4.12: Kết nối các khối trong Simatic đến module mờ (Fuzzy module)
4.2.1. Sử dụng DB mờ với FB30 (Fuzzy control)
Bộ điều khiển mờ được soạn thảo xong cần phải được cất giữ vào Project bằng lệnh File/save. Nó sẽ được lưu trữ vào Project dưới dạng một khối DB mà ta đặt tên. Khối dữ liệu mờ này được sử dụng cùng với khối hàm FB30 đã được lấy từ Project FuzConEx trong thư viện Simatic Manager. Bởi vậy khi sử dụng khối dữ liệu mờ ta phải kết thúc FCPA và quay lại Simatic Manager. Ta sử dụng cấu trúc sau: CALL FB30 ,DBx
Trong đó: DBx: Là khối dữ liệu mờ
FB30 (tên hình thức Fuzzy Control) có 8 đầu vào INPUT1÷ INPUT8, kiểu số thực, 4 biến ra OUTPUT1÷ OUTPUT4 cũng kiểu số thực và INFO kiểu byte. Khi thực hiện lệnh gọi như trên thì toàn bộ 8 biến đầu vào và 4 biến hình thức đầu ra sẽ hiện trên màn hình chờ truyền tham trị:
Luận văn thạc sĩ kỹ thuật 116 Chuyên ngành: Tự động hóa
CALL FB 30 , DB_FUZZY_CONTROL INPUT1 := et1 // vị trí sai lệch của động cơ 1
INPUT2 := det1 // đạo hàm sai lệch vị trí của động cơ 1 INPUT3 := et2 // vị trí sai lệch của động cơ 2
INPUT4 := det2 // đạo hàm sai lệch vị trí của động cơ 2 INPUT5 := // Không sử dụng
INPUT6 := // ---// INPUT7 := // --- // INPUT8 := // --- //
OUTPUT1 := HesoKP1 // Hệ số chỉnh định KP cho bộ PID1 OUTPUT2 := HesoKD1 // Hệ số chỉnh định KD cho bộ PID1 OUTPUT3 := HesoKP2 // Hệ số chỉnh định KP cho bộ PID2 OUTPUT4 := HesoKD2 // Hệ số chỉnh định KD cho bộ PID2 INFO := // Thanh ghi báo trạng thái của FB30
4.2.2. Thanh ghi báo trạng thái làm việc của FB30
Giá trị trả về có tên INFO với kích thước một byte là mã báo trạng thái thực hiện công việc của khối hàm FB30. Nó được quy định như sau:
- B#16#00 Khối hàm FB30 đã thực hiện bình thường
- B#16#01 Khối hàm FB30 không được thực hiện. Giá trị trả về ở đầu ra vẫn là giá trị cũ
- B#16#11 Không tìm thấy khối DB mờ đã chỉ thị. Có thể khối DB mờ này không được đổ vào CPU
- B#16#21 Khối dữ liệu DB mờ được gọi theo hàm FB30 không cùng kích thước về biến vào ra. START_STOP trong DB mờ đã được soạn thảo bằng chương trình FCPA, từ kép này có tác dụng như một biến điều kiện để thực hiện lệnh:
Luận văn thạc sĩ kỹ thuật 117 Chuyên ngành: Tự động hóa
CALL FB30, DB_FUZZY_CONTROL
- Nếu START_STOP= W#16#0000 lệnh sẽ thực hiện
- Ngược lại khi START_STOP ≠ W#16#0000 thì lệnh không được thực hiện.
KẾT LUẬN VÀ KIẾN NGHỊ 1. KẾT LUẬN.
Luận văn thạc sĩ kỹ thuật 118 Chuyên ngành: Tự động hóa
+ Khảo sát tổng quan về PLC S7 300 các module điều khiển như PID, Fuzzy…, tổng quan về tay máy hai bậc tự do, tính toán thiết kế bộ điều khiển PID, điều khiển mờ chỉnh định tham số PID để điều khiển quá trình chuyển động của tay máy di chuyển trong quỹ đạo đặt trước. Thiết kế chương trình mô phỏng trên simulink cho các kết quả quỹ đạo, sai lệch quỹ đạo, sai lệch tốc độ, đáp ứng dòng điện, tốc độ, momen có kết quả đáp ứng tốt. Với các kết quả này giúp cho việc khảo sát, đánh giá và hiệu chỉnh nâng cao chất lượng hệ thống điều khiển cánh tay robot.
+ Để nâng cao chất lượng của cánh tay Robot chuyển động theo quỹ đạo đặt trước, bản luận văn đã nghiên cứu và ứng dụng bộ điều khiển mờ chỉnh định tham số PID, với hệ thống điều khiển này chất lượng bám theo quỹ đạo của cánh tay Robot được nâng lên nhiều so với hệ điều khiển PID kinh điển: Làm giảm biên độ dao động ở các thời điểm quá độ giảm sai lệch quỹ đạo thực so với quỹ đạo đặt (<1%), giảm sai lệch tốc độ của chuyển động về gần bằng 0.
+ Trong luận văn có đưa ra phương pháp tích hợp bộ điều khiển mờ vào PLC S7- 300 đây là một hướng nghiên cứu mới và là nhiệm vụ cơ bản mà bản luận văn này
2. KIẾN NGHỊ.
Do thời gian nghiên cứu còn hạn hẹp và điều kiện cơ sở vật chất không cho phép nên luận văn chỉ dừng lại ở kết quả mô phỏng trên simulink và đưa ra phương pháp tích hợp bộ điều khiển mờ vào PLC S7-300, không làm mô hình thực tế của tay máy hai bậc tự do sử dụng bộ điều khiển mờ tích hợp vào PLC S7-300 để điều khiển, đây là phần hạn chế mà luận văn chưa hoàn thiện được. Tuy vậy kết quả mô phỏng cũng cho thấy tính đúng đắn của đề tài cần nghiên cứu. Để phát triển hơn nữa có thể tiến hành nghiên cứu thiết kế chế tạo mô hình tay máy hai bậc tự do dùng bộ điều khiển mờ tích hợp vào PLC S7-300 để điều khiển thì bản luận văn sẽ hoàn thiện hơn.
TÀI LIỆU THAM KHẢO
Luận văn thạc sĩ kỹ thuật 119 Chuyên ngành: Tự động hóa
[1]. Bùi Quốc Khánh, Nguyễn Văn Liễn, Nguyễn Thị Hiền: Truyền Động Điện, NXB Khoa Học và Kỹ Thuật.
[2]. Nguyễn Như Hiển, Lại Khắc Lãi (2007), Hệ mờ và nơron trong kỹ thuật điều
khiển, NXB Khoa học tự nhiên và công nghệ, Hà Nội.
[3]. Lại Khắc Lãi "Một phương pháp xây dựng mô hình đối tượng phi tuyến trong
hệ điều khiển dự báo" Tạp chí Khoa học Công nghệ - Đại học Thái Nguyên,
số3(43), trang 73-79, năm 2007.
[4]. Nguyễn Phùng Quang (2006), Matlab & Simulink, nhà xuất bản Khoa học và Kỹ thuật, Hà Nội.
[5]. Nguyễn Thiện Phúc: Robot Công nghiệp, NXB Khoa học và Kỹ thuật.
[6]. Nguyễn Trọng Thuần: Điều khiển lôgic và ứng dụng
[7]. Nguyễn Doãn Phước; Phan Xuân Minh: Lý thuyết điều khiển mờ
[8]. Nguyễn Doãn Phước, Phan Xuân Minh, Hán Thành Trung: Lý tuyết Điều khiển hệ phi tuyến
[9]. Nguyễn Doãn Phước . Phan Xuân Minh. Vũ Vân Hà: Tự Động Hoá Với
Simatic S7-300 , Nxb KHKT
[10]. Phạm Đăng Phước, Giáo trình Robot Công nghiệp (phần I), trường Đại học Bách khoa Đà nẵng.
• Tài liệu tiếng Anh
[1]. Han.Xion Li (1999), “Approximate model reference adaptive mechaism for
nominal gain design of fuzzy control system”, IEEE Transactions on Systems,
Man.And Cybernetics Part B: Cybernetics. Vol.29. No.4. February 1999, pp 661- 666.
[2]. FLi-Xin Wang and Jerry M. Mendel (1993), “Fuzzy adaptive Filters, with
Application to Nonlinear Channel Equalization”, IEEETransactions on fuzzy
Luận văn thạc sĩ kỹ thuật 120 Chuyên ngành: Tự động hóa
[3]. Li-Xin Wang (1992), “Fuzzy systems as nonlinear dynamic system
indentifiers. Part 1: design”, Proceedinge of the 31 st Conference on decision
and control Tucson, Arizos, December 1992. pp. 2511-2516. • Các Website
http://www.siemens.com.vn/index.htm; www. sciencedirect .com/ www. ebook.edu.vn / ; www.tnut.edu.vn/