BỘ ĐIỀU KHIỂN PID CHO HỆ CÂN BẰNG BALL AND BEAM - KHOÁ LUẬN TỐT NGHIỆP BẢN ĐẦY ĐỦ (FULL) - CHỈ DÙNG CHO MỤC ĐÍCH THAM KHẢO
Bạn đang xem bản rút gọn của tài liệu. Xem và tải ngay bản đầy đủ của tài liệu tại đây (3.04 MB, 73 trang )
<span class="text_page_counter">Trang 1</span><div class="page_container" data-page="1">
BỘ CÔNG THƯƠNG
<b>TRƯỜNG ĐẠI HỌC CÔNG NGHIỆP THỰC PHẨM TPHCM KHOA CÔNG NGHỆ ĐIỆN – ĐIỆN TỬ </b>
<b>KHỐ LUẬN TỐT NGHIỆP </b>
NGÀNH CƠNG NGHỆ KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HÓA
<b>THIẾT KẾ BỘ ĐIỀU KHIỂN PID CHO HỆ CÂN BẰNG BALL AND BEAM </b>
<b>GVHD: DƯƠNG VĂN KHẢI </b>
<b>TÊN SINH VIÊN: VŨ QUANG NGỌC MSSV: 2032180683 </b>
<b>LỚP: 09DHTDH1</b><sub> </sub>
THÀNH PHỐ HỒ CHÍ MINH, THÁNG 11 NĂM 2021
</div><span class="text_page_counter">Trang 2</span><div class="page_container" data-page="2">BỘ CÔNG THƯƠNG
<b>TRƯỜNG ĐẠI HỌC CÔNG NGHIỆP THỰC PHẨM TPHCM KHOA CÔNG NGHỆ ĐIỆN – ĐIỆN TỬ </b>
<b>KHỐ LUẬN TỐT NGHIỆP </b>
NGÀNH CƠNG NGHỆ KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HÓA
<b>THIẾT KẾ BỘ ĐIỀU KHIỂN PID CHO HỆ CÂN BẰNG BALL AND BEAM </b>
<b>GVHD: DƯƠNG VĂN KHẢI </b>
<b>TÊN SINH VIÊN: VŨ QUANG NGỌC MSSV: 2032180683 </b>
<b>LỚP: 09DHTDH1 </b>
THÀNH PHỐ HỒ CHÍ MINH, THÁNG 11 NĂM 2021
</div><span class="text_page_counter">Trang 3</span><div class="page_container" data-page="3">- ii -
<b><small>Mẫu số 3a: Tờ Nhiệm vụ khóa luận tốt nghiệp</small></b>
TRƯỜNG ĐẠI HỌC CÔNG NGHIỆP THỰC PHẨM TP. HỒ CHÍ MINH
<b>KHOA CN ĐIỆN – ĐIỆN TỬ </b>
<b>CỘNG HOÀ XÃ HỘI CHỦ NGHĨA VIỆT NAM Độc lập – Tự do – Hạnh phúc </b>
<b>NHIỆM VỤ KHÓA LUẬN TỐT NGHIỆP </b>
<b>1. Họ và tên sinh viên được giao đề tài (Số lượng sinh viên: 1) </b><b>2. Tên đề tài: Thiết kế bộ điều khiển PID cho hệ cân bằng Ball and Beam 3. Nhiệm vụ của đề tài: </b>
- Tìm hiểu tổng quan mơ hình hệ thống Ball and Beam. - Thiết kế bộ điều khiển PID cho hệ thống Ball and Beam. - Mô phỏng hệ thống trên phần mềm Matlab.
- Kiểm tra, đánh giá kết quả dựa trên kết quả mô phỏng và mơ hình thực nghiệm.
<b>4. Ngày giao nhiệm vụ: 10/08/2021 </b>
<b>5. Ngày hoàn thành và nộp về khoa: 25/10/2021 </b>
<i>Tp.HCM, ngày 17 tháng 7 năm 2021 </i>
<b> Trưởng khoa Trưởng bộ môn Giảng viên hướng dẫn </b>
Lê Thành Tới Nguyễn Phú Công Dương Văn Khải
</div><span class="text_page_counter">Trang 4</span><div class="page_container" data-page="4">- iii -
<b><small>Mẫu số 4a: Bản nhận xét của GVHD</small></b>
TRƯỜNG ĐẠI HỌC CÔNG NGHIỆP THỰC PHẨM TP. HỒ CHÍ MINH
<b>KHOA CN ĐIỆN – ĐIỆN TỬ </b>
<b>CỘNG HOÀ XÃ HỘI CHỦ NGHĨA VIỆT NAM Độc lập – Tự do – Hạnh phúc </b>
<b>BẢNG NHẬN XÉT CỦA GIẢNG VIÊN HƯỚNG DẪN KHÓA LUẬN TỐT NGHIỆP </b>
<b>1. Họ và tên sinh viên được giao đề tài (Số lượng sinh viên: 01) </b>
<i><b>a) Về tinh thần, thái độ làm việc của sinh viên: </b></i>
- Làm việc nghiêm túc, có tinh thần ham học hỏi trong q trình thực hiện khóa luận.
<i><b>b) Những kết quả đạt được của KLTN: </b></i>
- Khóa luận đáp ứng đầy đủ các yêu cầu cơ bản của giáo viên hướng dẫn đặt ra
- Khóa luận đã thực hiện được việc mơ phỏng mơ hình hệ thống trên phần mềm Matlab - Mơ hình cơ bản đã thực hiện điều khiển bóng theo vị trí đã đặt trước
<i><b>c) Những hạn chế của KLTN: </b></i>
- Mơ hình chưa chắc chắn, việc sử dụng cảm biến quang để xác định vị trí bóng dẫn đến cịn dễ bị nhiễu
- Mơ hình hoạt động chưa ổn định
<b>5. Đề nghị: Được bảo vệ </b> Không được bảo vệ
</div><span class="text_page_counter">Trang 6</span><div class="page_container" data-page="6">- v -
<b><small>Mẫu số 5a: Bản nhận xét của GVPB</small></b>
TRƯỜNG ĐẠI HỌC CƠNG NGHIỆP THỰC PHẨM TP. HỒ CHÍ MINH
<b>KHOA CN ĐIỆN – ĐIỆN TỬ </b>
<b>CỘNG HOÀ XÃ HỘI CHỦ NGHĨA VIỆT NAM Độc lập – Tự do – Hạnh phúc </b>
<b>BẢNG NHẬN XÉT CỦA GIẢNG VIÊN PHẢN BIỆN KHÓA LUẬN TỐT NGHIỆP </b>
<b>1. Họ và tên sinh viên được giao đề tài (Số lượng sinh viên: 01) </b>
<b>2. Tên đề tài: Thiết kế bộ điều khiển PID cho hệ cân bằng Ball and Beam 3. Họ tên giảng viên hướng dẫn: Dương Văn Khải </b>
<b>4. Nhận xét: </b>
<i><b>a) Những kết quả đạt được của KLTN: </b></i>
- Đạt được cơ bản mục tiêu đề ra
<i><b>b) Những hạn chế của KLTN: </b></i>
- Phạm vi đề tài chưa nêu rõ giới hạn hoạt động của hệ thống
- Đánh giá kết quả điều khiển vị trí quả bóng dựa trên tín hiệu Analog trả về từ GP2Y0A21YK0F khơng đủ độ chính xác
- Kết quả điều khiển thực tế chưa tốt, độ vọt lố trong ba vị trí đặt đều lớn hơn 89%
<b>5. Đề nghị: Được bảo vệ Không được bảo vệ 6. Các câu hỏi sinh viên cần trả lời trước hội đồng: </b>
(1) Tần số lấy mẫu của hệ thống là bao nhiêu ?
(2) Trong báo cáo trang 24, SV viết “vì lý do sinh viên tìm hiểu được rằng, hệ Ball and Beam trục lệch điều khiển khó hơn trục giữa nên sinh viên chọn mơ hình Ball and Beam trục lệch thử sức khả năng bản thân”. SV hãy nêu nguồn trích dẫn nhận định này.
(3) Trong báo cáo trang 46, SV viết “Giá trị nhận được sai lệch nhiều có thể do cấu tạo hình cầu của quả bóng khơng phải lúc nào cảm biến cúng đọc đúng tâm của quả bóng”. Như vậy
</div><span class="text_page_counter">Trang 7</span><div class="page_container" data-page="7">- vi -
cảm biến xác định vị trí của quả bóng là dựa vào hình dạng ? Và để cảm biến hoạt động chính xác nhất thì SV đề xuất phương án khắc phục gì ?
(4) Trình bày chi tiết kết quả mô phỏng ở mục 3.1.1 trong báo cáo: nêu rõ điều kiện đầu, giá trị đặt theta và giải thích kết quả
(5) Mục tiêu của đề tài là thiết kế bộ điều khiển PID, tuy nhiên SV mô phỏng thiết kế bộ điều khiển tốt nhất lại là PD (trong báo cáo trang 44). SV hãy giải thích lý do có kết quả
</div><span class="text_page_counter">Trang 8</span><div class="page_container" data-page="8">- vii -
<b>LỜI CAM ĐOAN </b>
Tôi xin cam đoan đây là cơng trình nghiên cứu của riêng tôi và được sự hướng dẫn của Thầy Dương Văn Khải. Các nội dung nghiên cứu, kết quả trong đề tài này là trung thực và chưa cơng bố dưới bất kỳ hình thức nào trước đây. Những số liệu trong các bảng biểu phục vụ cho việc phân tích, nhận xét, đánh giá được chính tác giả thu thập từ các nguồn khác nhau có ghi rõ trong phần tài liệu tham khảo.
Ngồi ra, trong Khóa luận tốt nghiệp cịn sử dụng một số nhận xét, đánh giá cũng như số liệu của các tác giả khác, cơ quan tổ chức khác đều có trích dẫn và chú thích nguồn gốc.
<b>Nếu phát hiện có bất kỳ sự gian lận nào tơi xin hồn tồn chịu trách nhiệm về nội dung Khóa luận tốt nghiệp của mình. Trường Đại học Cơng nghiệp Thực phẩm </b>
Thành Phố Hồ Chí Minh khơng liên quan đến những vi phạm tác quyền, bản quyền do
<b>tơi gây ra trong q trình thực hiện (nếu có). </b>
<i>TP. Hồ Chí Minh, ngày 15 tháng 11 năm 2021 Sinh viên </i>
<i> </i>
<i> Vũ Quang Ngọc </i>
</div><span class="text_page_counter">Trang 9</span><div class="page_container" data-page="9">- viii -
<b>LỜI CẢM ƠN </b>
Trong thời gian làm Khóa luận tốt nghiệp, em đã nhận được nhiều sự giúp đỡ, đóng góp ý kiến và chỉ bảo nhiệt tình của Thầy, gia đình và bạn bè.
Em xin gởi lời cảm ơn chân thành đến thầy Dương Văn Khải, giảng viên hướng dẫn KLTN, người đã tận tình hướng dẫn, chỉ bảo em trong suốt quá trình làm đề tài này. Em cũng xin chân thành cảm ơn các thầy cô giáo trong trường Đai học Công Nghiệp Thực Phẩm TP. Hồ Chí Minh nói chung, các thầy cô trong khoa Công nghệ Kỹ thuật – Điều Khiển và Tự Động Hóa nói riêng đã dạy dỗ cho em về kiến thức các môn đại cương cũng như các mơn chun ngành, giúp em có được cơ sở lý thuyết vững vàng và tạo điều kiện giúp đỡ em trong suốt quá trình học tập.
Cuối cùng, em xin chân thành cảm ơn gia đình và bạn bè, đã ln tạo điều kiện, quan tâm, giúp đỡ, động viên em trong suốt quá trình học tập và hồn thành đề tài KLTN
</div><span class="text_page_counter">Trang 10</span><div class="page_container" data-page="10">- ix -
<i><b>TÓM TẮT </b></i>
Theo dự đoán trong tương lai, robot sẽ là tâm điểm của một cuộc cách mạng lớn sau Internet. Con người sẽ có nhu cầu sở hữu một robot cá nhân như nhu cầu một máy tính PC bây giờ. Với xu hướng này, cùng các ứng dụng truyền thống khác của robot trong công nghiệp, y tế, giáo dục đào tạo, giải trí và đặc biệt là trong an ninh quốc phịng thì thị trường robot sẽ vô cùng to lớn. Cuộc cách mạng về robot đã mở ra một thời kì mới cho nhân loại. Tạo ra một kỉ nguyên về khám phá vũ trụ. Robot ngày càng đóng vai trị quan trọng trong công nghiệp và cuộc sống hàng ngày. Chúng sẽ thực hiện những công việc rất nhàm chán hoặc nguy hiểm, những công việc mà tốc độ và độ chính xác vượt quá khả năng của con người. Trong số đó có nhiều nghiên cứu về độ chính xác ấy khơng thể khơng kể đến đó là hệ “Ball and Beam” cịn gọi là “hệ cân bằng của quả bóng trên thanh đỡ”.
Hệ quả bóng và thanh đỡ đã được biết đến sử dụng từ nhiều thập niên trước đây. Cho đến nay việc giải quyết bài toán này đã đưa ra nhiều ứng dụng đặc biệt là trong học tập và nghiên cứu. Hệ thống này được sử dụng như bài thí nghiệm ở nhiều trường đại học kỹ thuật trên thế giới vì nó khá gần gũi với các hệ thống điều khiển thực. Mục đích của hệ thống là điều khiển vị trí của quả bóng trên thanh đỡ sao cho nó đạt đúng giá trị mong muốn dưới các ảnh hưởng từ nhiễu bên ngoài.
Với đề tài “Thiết kế bộ điều khiển PID cho hệ cân bằng Ball and Beam”, khi thực hiện đã có cơ hội tìm hiểu thêm về lĩnh vực điều khiển chính xác. Đề tài này sử dụng phần mềm Arduino IDE và Matlab (bản 2020b) để thực hiện.
</div><span class="text_page_counter">Trang 11</span><div class="page_container" data-page="11">
1.3. Đối tượng và phạm vi nghiên cứu ... 1
1.4. Phương pháp nghiên cứu ... 1
CHƯƠNG 2. CƠ SỞ LÝ THUYẾT ... 3
2.1. Mơ hình hóa hệ thống ... 3
2.1.1. Mơ hình hóa hệ Ball and Beam trục giữa ... 3
2.1.2. Mơ hình hóa hệ Ball and Beam trục lệch ... 6
2.2. Bộ điều khiển PID ... 9
2.2.1. Giới thiệu PID ... 9
2.2.2. Hàm truyền ... 10
2.2.3. Đặc tính bộ điều khiển PID ... 10
2.3. Các phương pháp chọn tham số cho bộ điều khiển PID ... 11
2.3.1. Phương pháp Ziegler – Nichols ... 11
</div><span class="text_page_counter">Trang 12</span><div class="page_container" data-page="12">CHƯƠNG 3. CƠ SỞ THỰC HIỆN ... 26
3.1. Mô phỏng hệ thống Ball & Beam trên Matlab ... 26
3.1.1. Hệ thống khi chưa có bộ điều khiển ... 27
3.1.2. Hệ thống khi có bộ điều khiển P ... 28
3.1.3. Hệ thống khi có bộ điều khiển PD ... 31
3.1.4. Hệ thống khi có thêm khâu tích phân I ... 35
3.2. Đọc tín hiệu khoảng cách từ cảm biến: ... 37
3.2.1. Đọc tín hiệu cảm biến ... 37
3.2.2. Lọc nhiễu thông qua bộ lọc Kalman: ... 39
3.3. Chỉnh định thông số PID bằng thực nghiệm ở mơ hình thực tế ... 40
3.4. Lưu đồ giải thuật ... 42
3.5. Thiết kế phần cứng ... 44
3.5.1. Sơ đồ kết nối phần cứng ... 44
3.5.2. Mơ hình thực tế ... 44
CHƯƠNG 4. KẾT QUẢ VÀ THẢO LUẬN ... 48
4.1. Kết quả điều khiển mơ hình thực tế ... 48
4.2. Kết quả mơ phỏng trên Matlab ... 51
4.3. Thảo luận ... 51
CHƯƠNG 5. KẾT LUẬN VÀ HƯỚNG PHÁT TRIỂN ... 53
</div><span class="text_page_counter">Trang 13</span><div class="page_container" data-page="13">- xii -
5.1. Kết luận ... 53
5.2. Hướng phát triển đề tài ... 53
TÀI LIỆU THAM KHẢO ... 54
PHỤ LỤC… ... 55
Phụ lục 1. Code chương trình ... 55
</div><span class="text_page_counter">Trang 14</span><div class="page_container" data-page="14">- xiii -
<b>DANH MỤC CÁC THUẬT NGỮ, CHỮ VIẾT TẮT </b>
<b>Viết tắt Tiếng anh (nếu có) Tiếng việt </b>
PID Proportional Integral Derivative Bộ điều khiển vi tích phân tỉ lệ
</div><span class="text_page_counter">Trang 15</span><div class="page_container" data-page="15">- xiv -
<b>DANH SÁCH BẢNG </b>
Bảng 2.1. Bảng tham số hệ Ball and Beam trục giữa ... 4
Bảng 2.2. Bảng tham số hệ Ball and Beam trục lệch ... 7
Bảng 2.3. Ảnh hưởng của hệ số PID đối với hệ thống ... 11
Bảng 2.4. Các tham số PID theo phương pháp Ziegler-Nichols thứ nhất ... 12
Bảng 2.5. Các tham số PID theo phương pháp Ziegler-Nichols thứ hai ... 13
Bảng 2.6. Các tham số PID theo phương pháp Chien-Hrones-Reswick 1 ... 14
Bảng 2.7. Các tham số PID theo phương pháp Chien-Hrones-Reswick 2 ... 14
Bảng 2.8. Các tham số PID theo phương pháp Chien-Hrones-Reswick 3 ... 15
Bảng 2.9. Các tham số PID theo phương pháp Chien-Hrones-Reswick 4 ... 15
Bảng 3.1. Bảng tham số mô phỏng hệ thống ... 27
Bảng 4.1. Kết quả mô phỏng trên Matlab ... 51
Bảng 4.2. Kết quả điều khiển trên mơ hình thực tế... 52
</div><span class="text_page_counter">Trang 16</span><div class="page_container" data-page="16">- xv -
<b>DANH SÁCH HÌNH </b>
Hình 2.1. Mơ hình Ball and Beam trục giữa ... 3
Hình 2.2. Tọa độ tổng quát của hệ thống Ball and Beam trục giữa ... 4
Hình 2.3. Tọa độ tổng quát của hệ Ball and Beam trục lệch ... 6
Hình 2.4. Sơ đồ khối của bộ điều khiển PID ... 9
Hình 2.5. Sơ đồ khối của một hệ thống ... 10
Hình 2.6. Đáp ứng nấc của hệ hở có dạng S ... 11
Hình 2.7. Xác định hằng số khuếch đại tới hạn ... 12
Hình 2.8. Đáp ứng nấc của hệ kín khi k = kth ... 13
Hình 2.9. Đáp ứng nấc hệ thích hợp cho phương pháp Chien-Hrones-Reswick ... 14
Hình 2.10. Kit Arduino UNO R3 ... 16
Hình 2.11. Thơng số kỹ thuật của Arduino UNO R3 ... 17
Hình 2.12. Pin sạc Lithium Li-on Samsung ICR18650 ... 18
Hình 2.13. Đế pin 18650 nối tiếp ... 19
Hình 2.14. Động cơ MG996R ... 19
Hình 2.15. Cấu tạo bên trong của động cơ MG996R ... 20
Hình 2.16. Nguyên lý hoạt động của động cơ MG996R ... 21
Hình 2.17. Khối cảm biến GP2Y0A21YK0F ... 22
Hình 2.18. cảm biến GP2Y0A21YK0F ... 23
Hình 2.19. LED hồng ngoại và bộ PSD ... 23
Hình 2.20. Thay đổi góc chùm tia phản xạ &v ị trí của quang học trên PSD. ... 24
Hình 3.1. Mơ hình thử nghiệm mơ phỏng ... 26
Hình 3.2. Sơ đồ mơ phỏng hệ thống khi chưa có bộ điều khiển ... 27
Hình 3.3. Sơ đồ khối mơ phỏng hệ quả bóng trên thanh đỡ ... 28
Hình 3.4. Hệ thống khi chưa có PID ... 28
Hình 3.5. Sơ đồ khối mô phỏng hệ thống với bộ điều khiển P ... 29
</div><span class="text_page_counter">Trang 17</span><div class="page_container" data-page="17">- xvi -
Hình 3.10. Hệ thống khi có Kp = 6, Ki =0, Kd =1 ... 32
Hình 3.11. Hệ thống khi có Kp = 6, Ki =0, Kd =4 ... 33
Hình 3.12. Hệ thống khi có Kp = 6, Ki =0, Kd = 9 ... 33
Hình 3.13. Hệ thống sau khi tinh chỉnh với giá trị đặt là 0.2m ... 34
Hình 3.14. Hệ thống sau khi tinh chỉnh với giá trị đặt là 0.7m ... 34
Hình 3.15. Hệ thống sau khi tinh chỉnh với giá trị đặt là 0.9m ... 35
Hình 3.16. Hệ thống với Kp = 6, Ki = 0.05, Kd = 9 ... 36
Hình 3.17. Hệ thống với Kp = 6, Ki = 0.2, Kd = 9 ... 36
Hình 3.18. Tín hiệu cảm biến khi nhà sản xuất thực nghiệm ... 37
Hình 3.19. Kết quả cảm biến trả về giá trị thấp nhất ... 38
Hình 3.20. Kết quả cảm biến trả về giá trị cao nhất ... 38
Hình 3.21. Hoạt động của bộ lọc kalman ... 39
Hình 3.22. Kết quả lọc nhiễu cảm biến thông qua bộ lọc Kalman ... 40
Hình 3.23. Thực nghiệm đặt Ki và Kd = 0, tăng Kp đến khi dao động ... 41
Hình 3.30. Tổng quan mơ hình thực tế nhìn phía trên xuống ... 46
Hình 3.31. Tổng quan mơ hình thực tế nhìn từ phía trước ... 47
Hình 4.1. Hệ thống sau khi có bộ điều khiển PID chưa chỉnh định chính xác... 48
Hình 4.2. Hệ thống sau khi chỉnh định các hệ số Kp, Ki, Kd bằng thực nghiệm .. 49
Hình 4.3. Kết quả vị trí quả bóng ở mơ hình thực nghiệm ... 49
Hình 4.4. Kết quả điều khiển vị trí 19cm với bộ PID cho vị trí 15cm ... 50
Hình 4.5. Kết quả điều khiển vị trí 25cm với bộ PID cho vị trí 15cm ... 50
Hình 4.6. Hệ thống khi có bộ điều khiển PID ... 51
</div><span class="text_page_counter">Trang 18</span><div class="page_container" data-page="18">- 1 -
<b>CHƯƠNG 1. TỔNG QUAN VỀ ĐỀ TÀI 1.1. Lý do chọn đề tài </b>
Hệ quả bóng và thanh đỡ cịn được gọi là “hệ cân bằng của quả bóng trên thanh đỡ”. Hệ thống này được sử dụng như một bài thí nghiệm ở hầu hết các trường đại học kỹ thuật trên thế giới vì nó khá gần gũi với các hệ thống điều khiển thực nó giống như việc ổn định hệ thống cân bằng máy bay theo phương ngang khi hạ cánh dưới tác động hỗn loạn của các dịng khí. Mục đích của hệ thống là điều khiển vị trí của quả bóng trên thanh đỡ sao cho nó đạt đúng vị trí mong muốn dưới các ảnh hưởng từ nhiễu bên ngoài như lực đẩy từ tay chúng ta. Tín hiệu điều khiển có thể nhận được từ tín hiệu phản hồi vị trí của quả bóng qua các bộ cảm biến. Tín hiệu phản hồi được đưa tới bộ vi điều khiển qua đó xác định vị trí quả bóng và các thơng số liên quan để đưa tín hiệu điều khiển. tín hiệu điều khiển này được đưa tới động cơ RC Servo sẽ điều khiển chính xác góc quay của động cơ. Từ đó, quả bóng sẽ đạt đến đúng vị trí mong muốn.
Cũng chính vì lý do tị mị nên sẽ quyết định tiếp xúc một phần nhỏ của cơng trình đó là hệ Ball and Beam và từ đó đã chọn đề tài “Thiết kế bộ điều khiển PID cho hệ Ball and Beam”.
<b>1.2. Mục đích </b>
Củng cố kiến thức đã học và ứng dụng được kiến thức thực tế vào đề tài, nâng cao và trao dồi thêm kiến thức về khả năng lập trình ngơn ngữ lập trình Arduino. Điều khiển chính xác được quả bóng trên hệ thống Ball and Beam với độ vọt lố, thời gian xác lập nhỏ, cũng như khơng có sai số xác lập.
<b>1.3. Đối tượng và phạm vi nghiên cứu </b>
Đối tượng nghiên cứu của đề tài là hệ thống Ball and Beam mà cụ thể ở đây đề tài chọn là mơ hình Ball and Beam trục lệch.
Phạm vi nghiên cứu của đề tài là thiết kế bộ điều khiển PID cho hệ thống Ball and Beam trục lệch bằng phương pháp mô phỏng trên phần mềm MATLAB và điều khiển trên mơ hình thực tế.
<b>1.4. Phương pháp nghiên cứu </b>
Tìm hiểu về hệ thống Ball and Beam, các đặc tính và các phương pháp điều khiển. Xây dựng mơ hình bộ điều khiển kinh điển PID trên phần mềm mô phỏng
</div><span class="text_page_counter">Trang 19</span><div class="page_container" data-page="19">- 2 -
Simulink, sau đó đánh giá sơ bộ về kết quả thu được đối với đối tượng hệ Ball and Beam. Tiến hành thiết kế và thi cơng điều khiển trên mơ hình thực tế.
</div><span class="text_page_counter">Trang 20</span><div class="page_container" data-page="20">- 3 -
<b>CHƯƠNG 2. CƠ SỞ LÝ THUYẾT2.1. Mơ hình hóa hệ thống </b>
Đối với hệ Ball and Beam này, đã có rất nhiều các cá nhân tổ chức trên thế giới nghiên cứu, nhưng ở đây sinh viên sẽ chỉ nêu ra hai hệ Ball and Beam phổ biến là hệ Ball and Beam trục giữa và hệ Ball and Beam trục lệch.
<b>2.1.1. Mơ hình hóa hệ Ball and Beam trục giữa </b>
Hình 2.1. Mơ hình Ball and Beam trục giữa
Ở mơ hình này ta cần điều khiển vị trí trái bóng sao cho quả bóng nằm ở vị trí ta mong muốn và khi trái bóng đặt ở vị trí mong muốn rồi thì thanh beam phải nằm ngang hoàn toàn, hệ Ball and Beam này sẽ được gắn với động cơ, động cơ này có thể gắn trực tiếp vào trục này hoặc gắn ở vị trí nào nó rồi truyền bánh răng qua để xoay thanh beam.
</div><span class="text_page_counter">Trang 21</span><div class="page_container" data-page="21">- 4 -
Hình 2.2. Tọa độ tổng quát của hệ thống Ball and Beam trục giữa
Biến trạng thái của hệ thống là đại lượng khi biết về nó thì ta sẽ biết được hoạt động của hệ thống ngay tại thời điểm đó chẳng hạn ta biết vị trí hịn bi, biết góc lệch thanh beam, biết vận tốc hịn bi thì ta sẽ biết được trạng thái của hệ thống Ball and Beam tại thời điểm đó, do đó ta gọi hàm vị trí của hịn bi trên thanh beam là <i><small>r t</small></i><small>( )</small>và góc lệch của thanh beam theo phương ngang là <small>( )</small><i><small>t</small></i> biến trạng thái đặt là ma trận <i><small>q t</small></i><small>( )</small>:
Các hằng và biến được định nghĩa như sau:
Bảng 2.1. Bảng tham số hệ Ball and Beam trục giữa
</div><span class="text_page_counter">Trang 23</span><div class="page_container" data-page="23">- 6 -
<b>2.1.2. Mơ hình hóa hệ Ball and Beam trục lệch </b>
Hình 2.3. Tọa độ tổng quát của hệ Ball and Beam trục lệch
Cấu trúc toán học của hệ Ball and Beam trục lệch được thể hiện ở hình (2.3), đây là mơ hình sinh viên sẽ thực hiện trong đề tài khóa luận lần này, lúc bấy giờ thanh beam có thể quay tự do quanh một đầu cố định, cịn đầu kia nó quay tự do được là do nó được gắn vơ một thanh và thanh đó được gắn lên đĩa trịn, có một động cơ được gắn ngay đó, khi động cơ quay thì sẽ làm đĩa trịn quay, đĩa trịn quay làm cho thanh có chiều dài cố định Lever Arm nó di chuyển và làm cho thanh beam này quay lên xuống, và góc quay của thanh beam này so với trục nằm ngang sẽ tạo ra 1 góc <sub>. Khi thanh beam quay sẽ </sub>
làm cho hịn bi này di chuyển trên thanh beam, thì khi hòn bi di chuyển sẽ tạo ra một vị trí r so với điểm góc A. Ta có r và chính là hai biến trạng thái của hệ thống, biết được góc , biết được r, biết được vận tốc góc , biết được vận tốc di chuyển của hòn bi là r đạo hàm theo thời gian, ta sẽ biết được hệ thống này trạng thái hoạt động lúc đó của nó sẽ như thế nào. Do và quan hệ với nhau thơng qua một biểu thức cho nên từ
có thể suy ra được , từ có thể suy ra được <sub>, vậy 2 biến </sub> và cũng chỉ là một mà thôi, nên ở đây ta sẽ chọn là biến trạng thái.
</div><span class="text_page_counter">Trang 24</span><div class="page_container" data-page="24">- 7 -
Đối với bài tốn này, chúng ta sẽ giả sử rằng quả bóng lăn mà không bị trượt và ma sát giữa thanh ngang và quả bóng là khơng đáng kể. Các hằng và biến cho thử nghiệm này được định nghĩa như sau:
Bảng 2.2. Bảng tham số hệ Ball and Beam trục lệch
Động năng hệ thống (<i><small>T</small></i> ):động năng quả bóng (<i><small>T</small><sub>B</sub></i>), động năng thanh beam (<i><small>T</small><sub>b</sub></i>). Động năng quả bóng gồm: Động năng tịnh tiến di chuyển của quả bóng theo phương nào, theo đường thẳng nào và có thêm động năng quay của quả bóng vì trong q trình di chuyển quả bóng sẽ quay quanh chính bản thân nó .
</div><span class="text_page_counter">Trang 26</span><div class="page_container" data-page="26">- 9 -
Đạo hàm thứ hai của góc đầu vào thực sự ảnh hưởng đến đạo hàm thứ hai của r. Tuy nhiên sinh viên sẽ bỏ qua đóng góp này. Khi đó, phương trình chuyển động của
<b>2.2. Bộ điều khiển PID </b>
<b>2.2.1. Giới thiệu PID </b>
Bộ điều khiển PID (A proportional integral derivative controller) là bộ điều khiển sử dụng kỹ thuật điều khiển theo vòng lặp dụng kỹ thuật điều khiển theo vòng lặp có hồi tiếp được sử dụng rộng rãi trong các hệ thống điều khiển tự động.
Một bộ điều khiển PID cố gắng hiệu chỉnh sai lệch giữa tín hiệu ngõ ra và ngõ vào sau đó đưa ra một một tín hiệu điều khiển để điều chỉnh quá trình cho phù hợp.
Bộ điều khiển kinh điển PID đã và đang được sử dụng rộng rãi để điều khiển các đối tượng SISO bởi vì tính đơn giản của nó cả về cấu trúc lẫn nguyên lý làm việc. Bộ điều chỉnh này làm việc rất tốt trong các hệ thống có qn tính lớn như điều khiển tốc độ, điều khiển mức,... và trong các hệ điều khiển tuyến tính hay có mức độ phi tuyến thấp.
PID là một trong những lý thuyết cổ điển và cũ nhất dùng cho điều khiển tuy nhiên nó vẫn ứng dụng rộng rãi cho đến ngày nay.
Sơ đồ khối của bộ điều khiển PID:
Hình 2.4. Sơ đồ khối của bộ điều khiển PID
</div><span class="text_page_counter">Trang 27</span><div class="page_container" data-page="27">Xét 1 hệ thống có sơ đồ khối như sau:
Hình 2.5. Sơ đồ khối của một hệ thống Plant: đối tượng cần điều khiển
Controller: đưa tín hiệu điều khiển đối tượng, được thiết kế để hệ thống đạt đáp ứng mong muốn .
Biến e là thành phần sai lệch, là hiệu giữa giá trị tín hiệu vào mong muốn và tín hiệu ra thực tế. Tín hiệu sai lệch (e) sẽ đưa tới bộ PID, và bộ điều khiển tính tốn cả thành phần tích phân lẫn vi phân của (e). Tín hiệu ra (u) của bộ điều khiển bằng:
Lúc này đối tượng điều khiển có tín hiệu vào là (u), và tín hiệu ra là (Y). (Y) được hồi tiếp về bằng các cảm biến để tiếp tục tính sai lệch (e). Và bộ điều khiển lại tiếp tục như trên.
<b>2.2.3. Đặc tính bộ điều khiển PID </b>
Thành phần tỉ lệ (Kp) có tác dụng làm tăng tốc độ đáp ứng của hệ, và làm giảm chứ không triệt tiêu sai số xác lập của hệ (steady-state error).
Thành phần tích phân (Ki) có tác dụng triệt tiêu sai số xác lập nhưng có thể làm giảm tốc độ đáp ứng của hệ.
Thành phần vi phân (Kd) làm tăng độ ổn định hệ thống, giảm độ vọt lố và cải thiện tốc độ đáp ứng của hệ.
</div><span class="text_page_counter">Trang 28</span><div class="page_container" data-page="28">- 11 -
Ảnh hưởng các thành phần Kp, Ki, Kd với hệ kín được tóm tắt trong bảng sau: Bảng 2.3. Ảnh hưởng của hệ số PID đối với hệ thống
<b>2.3. Các phương pháp chọn tham số cho bộ điều khiển PID </b>
<b>2.3.1. Phương pháp Ziegler – Nichols </b>
Là phương pháp thực nghiệm để xác định tham số của bộ điều khiển P, PI hoặc PID bằng cách dựa vào đáp ứng quá độ của đối tượng điều khiển. Tùy theo đặc điểm của từng đối tượng điều khiển mà Ziegler-Nichols đã đưa ra hai phương pháp lựa chọn tham số:
Phương pháp Ziegler-Nichols thứ nhất: phương pháp này áp dụng cho các đối tượng có đáp ứng đối với tín hiệu vào là hàm nấc có dạng chữ S như điều khiển nhiệt độ lò nhiệt, tốc độ động cơ,..
Hình 2.6. Đáp ứng nấc của hệ hở có dạng S Đáp ứng vịng
kín Thời gian lên Vọt lố Thời gian xác lập Sai số xác lập
</div><span class="text_page_counter">Trang 29</span><div class="page_container" data-page="29">- 12 -
Thông số của các bộ điều khiển được chọn theo bảng sau:
Bảng 2.4. Các tham số PID theo phương pháp Ziegler-Nichols thứ nhất
<b>Phương pháp Ziegler-Nichols thứ hai: Phương pháp này áp dụng cho đối tượng </b>
có khâu tích phân lý tưởng như mực chất lỏng trong bồn chứa, vị trí hệ truyền động dùng động cơ… Đáp ứng quá độ của hệ hở của đối tượng tăng đến vô cùng. Phương pháp này được thực hiện như sau:
<b>Hình 2.7. Xác định hằng số khuếch đại tới hạn </b>
Thay bộ điều khiển PID trong hệ kín bằng bộ khuếch đại (hình 2.7).
Tăng hệ số khuếch đại tới giá trị tới hạn Kth để hệ kín ở chế độ biên giới ổn định tức là h(t) có dạng dao động điều hịa.
Xác định chu kỳ Tth của dao động:
</div><span class="text_page_counter">Trang 30</span><div class="page_container" data-page="30">- 13 -
Hình 2.8. Đáp ứng nấc của hệ kín khi k = kth Thơng số của các bộ điều khiển được chọn theo bảng sau:
Bảng 2.5. Các tham số PID theo phương pháp Ziegler-Nichols thứ hai
<b>2.3.2. Phương pháp Chien-Hrones-Reswick </b>
Phương pháp này cũng áp dụng cho các đối tượng có đáp ứng đối với tín hiệu vào là hàm nấc có dạng chữ S (hình 2.9) nhưng có thêm điều kiện:
</div><span class="text_page_counter">Trang 31</span><div class="page_container" data-page="31">- 14 -
Hình 2.9. Đáp ứng nấc của hệ thích hợp cho phương pháp Chien-Hrones-Reswick Phương pháp Chien-Hrones-Reswick đưa ra bốn cách xác định tham số bộ điều khiển cho bốn yêu cầu chất lượng khác nhau:
- Yêu cầu tối ưu theo nhiễu và hệ kín khơng có độ quá điều chỉnh: Bảng 2.6. Các tham số PID theo phương pháp Chien-Hrones-Reswick 1
- Yêu cầu tối ưu theo nhiễu và hệ kín có độ quá điều chỉnh h không vượt quá
</div><span class="text_page_counter">Trang 32</span><div class="page_container" data-page="32">- Yêu cầu tối ưu theo nhiễu và hệ kín có độ q điều chỉnh h không vượt quá
<b>2.3.3. Phương pháp chỉnh định bằng thực nghiệm (thử và sai) </b>
Phương pháp này được thực hiện như sau: Đầu tiên thiết đặt giá trị đầu tiên của Ki và Kd bằng khơng, sau đó tăng dần Kd cho đến khi đầu ra của vòng điều khiển dao động, Kp có thể được đặt tới xấp xỉ một nửa giá trị đó để đạt được đáp ứng. Sau đó tăng Ki đến giá trị phù hợp sao cho đủ thời gian xử lý. Tuy nhiên, Ki quá lớn sẽ gây mất ổn định. Cuối cùng, tăng Kd nếu cần thiết, cho đến khi vịng điều khiển nhanh có thể chấp nhận được nhanh chóng lấy lại được giá trị đặt sau khi bị nhiễu. Tuy nhiên, Kd quá lớn sẽ gây đáp ứng dư và vọt lố.
</div><span class="text_page_counter">Trang 33</span><div class="page_container" data-page="33">- 16 -
<b>2.4. Vi điều khiển </b>
<b>2.4.1. Giới thiệu về Arduino UNO R3 </b>
Arduino Uno là một board mạch vi điều khiển được phát triển bởi Arduino.cc, một nền tảng điện tử mã nguồn mở chủ yếu dựa trên vi điều khiển AVR Atmega328P. Với Arduino chúng ta có thể xây dựng các ứng dụng điện tử tương tác với nhau thông qua phần mềm và phần cứng hỗ trợ.
Khi arduino chưa ra đời, để làm được một dự án điện tử nhỏ liên quan đến lập trình, biên dịch, chúng ta cần đến sự hỗ trợ của các thiết bị biên dịch khác để hỗ trợ. Ví dụ như, dùng Vi điều khiển PIC hoặc IC vi điều khiển họ 8051..., chúng ta phải thiết kế chân nạp onboard, hoặc mua các thiết bị hỗ trợ nạp và biên dịch như mạch nạp 8051, mạch nạp PIC.
Hình 2.10. Kit Arduino UNO R3
Trên thị trường có rất nhiều phiên bản Arduino như Arduino Uno R3, Arduino Uno R3 CH340, Arduino Mega2560, Arduino Nano, Arduino Pro Mino, Arduino Lenadro, Arduino Industrial.
<b>2.4.2. Thông số kỹ thuật </b>
</div><span class="text_page_counter">Trang 34</span><div class="page_container" data-page="34">- 17 -
Hình 2.11. Thơng số kỹ thuật của Arduino UNO R3
<b>Thông số kỹ thuật: </b>
- Chip điều khiển chính: ATmega328P
- Chip nạp và giao tiếp UART: ATmega16U2
- Nguồn nuôi mạch: 5VDC từ cổng USB hoặc nguồn ngoài cắm từ giắc trịn DC (nếu sử dụng nguồn ngồi từ giắc tròn DC Hshop.vn khuyên bạn nên cấp nguồn từ 6~9VDC để đảm bảo mạch hoạt động tốt, nếu bạn cắm 12VDC thì IC ổn áp rất nóng, dễ cháy và gây hư hỏng mạch).
- Số chân Digital I/O: 14 (trong đó 6 chân có khả năng xuất xung PWM). - Số chân PWM Digital I/O: 6
- Số chân Analog Input: 6
- Dòng điện DC Current trên mỗi chân I/O: 20 mA - Dòng điện DC Current chân 3.3V: 50 mA
- Flash Memory: 32 KB (ATmega328P), 0.5 KB dùng cho bootloader.
<b>Pin 18650: là một loại pin lithium-ion có thể sạc lại. Pin lithium-ion là cuộc cách </b>
mạng hóa các thiết bị cầm tay. Pin 18650 là pin có kích thước 18mm x 65mm. Mã pin 18650 dành riêng cho kích thước của pin lithium-ion với nhiều thương hiệu sản xuất
</div><span class="text_page_counter">Trang 35</span><div class="page_container" data-page="35">- 18 -
như pin Panasonic, Sony, Ansmann, Akasha… đã trở thành tiêu chuẩn vàng mới cho pin có thể thay thế và có thể sạc lại.
Hình 2.12. Pin sạc Lithium Li-on Samsung ICR18650
<b>Ý nghĩa của con số 18650: </b>
Hai số đầu là đường kính viên pin: ở đây là 18mm. Hai số tiếp theo là chiều sài viên pin, khoảng: 65mm. Số 0 cuối cùng để chỉ viên pin có hình trụ.
<b>Thơng số kỹ thuật: </b>
- Kiểu pin: 18650
- Điện áp trung bình 3.7VDC, sạc đầy 4.2VDC - Dung lượng: 2600mAh
- Các cell pin được nối tiếp với nhau với điện áp max là: 4,2 x 2 - Dây màu đỏ là dương (+)
- Dây màu đen là âm (-)
</div><span class="text_page_counter">Trang 36</span><div class="page_container" data-page="36">- 19 -
Hình 2.13. Đế pin 18650 nối tiếp
<b>2.6. Động cơ MG996R </b>
MG996R là động cơ servo bánh răng kim loại với mô-men xoắn cực đại là 11 kg/cm. Giống như các RC servo khác, động cơ quay từ 0 đến 180 độ dựa trên chu kỳ hoạt động của sóng PWM được cung cấp cho chân tín hiệu của nó.
Hình 2.14. Động cơ MG996R
<b>2.6.1. Thơng số kỹ thuật </b>
- Servo MG996R (nâng cấp MG995) có momen xoắn lớn
</div>
