Đặt vấn đề Cùng với sự phát triển của khoa học kĩ thuật, các phương pháp điều khiển từ kinh điển đến hiện đại, điều khiển thông minh ra đời. Hầu hết các đối tượng như cánh tay máy, hệ con lắc ngược quay… đều được giải quyết bởi các bài toán ổn định hệ thống với chất lượng cao hơn. Các phương pháp này ngày càng được nghiên cứu, phát triển, ứng dụng rộng rãi, góp phần nâng cao chất lượng, độ ổn định của hệ thống. Hệ con lắc ngược quay là hệ thống một vào - nhiều ra, nó có độ bất ổn định cao và là cơ sở để tạo ra các hệ thống tự cân bằng như: hệ xe con lắc ngược quay, hệ con lắc ngược quay, hệ Pendubot,… Đây là đối tượng thường được các nhà nghiên cứu lựa chọn để kiểm chứng những thuật toán điều khiển của mình, từ những thuật toán điều khiển cổ điển đến những thuật toán điều khiển hiện đại, điều khiển thông minh.
Tuy nhiên hệ con lắc ngược quay cũng đặt ra nhiều thách thức đối với lý thuyết điều khiển cũng như các thiết bị điều khiển chúng. Đòi hỏi có bộ điều khiển thích hợp và có tốc độ đáp ứng nhanh. Các nghiên cứu về điều khiển hệ thống con lắc ngược quay đã được tiến hành khá sớm, xuất phát từ nhu cầu thiết kế các hệ thống điều khiển cân bằng tên lửa trong giai đoạn đầu phóng. Trên phương diện nghiên cứu các kĩ thuật điều khiển thực, con lắc ngược quay đại diện cho lớp các đối tượng phi tuyến phức tạp.
HVTH: Lê Quang Vũ Trang 1 Luan van Luận văn thạc sĩ GVHD: PGS.TS DƢƠNG HOÀI NGHĨA Ở đề tài này đã có một số luận văn thạc sĩ Đại học Bách khoa TP.HCM, Đại học Giao thông Vận tải điều khiển thành công sử dụng giải thuật LQR, PID, Fuzzy. Tuy nhiên các giải thuật trên có những nhược điểm như sau: Giải thuật LQR điều khiển dựa vào thông số K tìm được từ việc tuyến tính hóa hệ thống nên chỉ điều khiển được mô hình quanh vị trí làm việc. Nếu trạng thái hệ thống quá xa vị trí cân bằng thì giải thuật không còn điều khiển tốt. Giải thuật PID là giải thuật tuyến tính trong khi con lắc ngược quay là một hệ phi tuyến mang tính phi tuyến điển hình.
Do vậy, bộ điều khiển PID có thể chưa đủ mức độ phức tạp để điều khiển hệ con lắc ngược quay trong một dải hoạt động rộng. Giải thuật Fuzzy phụ thuộc vào kinh nghiệm chuyên gia nên tốn rất nhiều thời gian thử sai nhiều lần và không tận dụng được hiểu biết về phương trình toán học của hệ thống. Từ các hạn chế nhất định của các bộ điều khiển trên, bộ điều khiển phi tuyến là một giải pháp để củng cố thêm. Với việc tận dụng được những kiến thức về mô hình (thông số hệ thống, phương trình toán học) thì việc thiết kế một bộ điều khiển đáp ứng tốt và ổn định được hệ thống trong một khoảng hoạt động rộng.
Trong khuôn khổ luận văn này, học viên xin chọn hướng đề tài: “ ĐIỀU KHIỂN TRƢỢT HỆ CON LẮC NGƢỢC ĐƠN” 1. Giới thiệu về con lắc ngƣợc quay Mô hình con lắc ngược quay là một hệ thống máy gồm hai khâu: cánh tay (Arm) và con lắc (pendulum). Trong điều khiển cân bằng, cánh tay gắn vào động cơ DC có một encoder gắn đồng trục để xác định vị trí góc cánh tay quay quanh trục thẳng đứng và con lắc gắn vào trục encoder ở cuối cánh tay tự do trong mặt phẳng vuông góc với cánh tay có khả năng xoay tự do trong mặt phẳng vuông góc với mặt phẳng ngang. HVTH: Lê Quang Vũ Trang 2 Luan van Luận văn thạc sĩ GVHD: PGS.TS DƢƠNG HOÀI NGHĨA Hình 1.1 Mô hình con lắc ngƣợc quay 1.
Một số công trình nghiên cứu có liên quan. Do hệ con lắc ngược quay là một hệ ứng dụng nhiều trong nghiên cứu giải thuật điều khiển cũng như mang tính học thuật cao nên nhiều dạng mô hình con lắc ngược quay được xây dựng và sử dụng tại các phòng thí nghiệm. Ngoài hệ con lắc ngược quay được đề cập ở phần trên còn có các hệ con lắc ngược khác như: hệ con lắc ngược quay một bậc tự do, hệ xe con lắc ngược… Hình 1.2 Một số mô hình phần cứng con lắc ngƣợc quay trƣớc đây HVTH: Lê Quang Vũ Trang 3 Luan van Luận văn thạc sĩ GVHD: PGS.TS DƢƠNG HOÀI NGHĨA Trong luận văn thạc sĩ “Nghiên cứu điều khiển trượt điều khiển con lắc ngược” của tác giả Huỳnh Xuân Dũng [2], trường Đại học Sư phạm Kỹ thuật 2012, hệ thống cũng đã được phân tích, mô phỏng và điều khiển. Các kết quả mô phỏng cho thấy hệ thống đáp ứng nhanh, tuy nhiên, đề tài chỉ thực hiện mô phỏng để kiểm tra thuật toán bộ điều khiển trượt, chưa ứng dụng bộ điều khiển vào mô hình thực hệ thồng con lắc ngược.
Do đó, chưa đánh giá được tính ổn định và bền vững của bộ điều khiển trượt. Mục tiêu và phạm vi nghiên cứu 1. Mục tiêu Trong luận văn này, mục tiêu là điều khiển cân bằng mô hình con lắc làm việc quanh vị trí cân bằng hướng lên, cụ thể là: Ứng dụng giải thuật trượt để điều khiển ổn định góc con lắc thẳng đứng, góc cánh tay đứng yên tại vị trí đặt. Ứng dụng giải thuật trượt điều khiển góc cánh tay dao động theo một quỹ đạo cho trước trong khi vẫn ổn định được góc con lắc thẳng đứng không ngã.
Phạm vi nghiên cứu Ứng dụng bộ điều khiển trượt, điều khiển mô hình con lắc ngược quay. Việc nghiên cứu được thực hiện cả trên mô phỏng trong môi trường Matlab/Simulink và thực hiện điều khiển cân bằng trên mô hình thực tế. Phƣơng pháp nghiên cứu Nghiên cứu lý thuyết: Nghiên cứu tài liệu để hiểu biết về đối tượng: mô hình toán, mô hình cơ khí, bố trí cảm biến, cách thức hoạt động…của một hệ con lắc ngược. Nghiên cứu tài liệu để nắm vững các giải thuật nhận dạng thông số mô hình, giải thuật điều khiển trượt để điều khiển cân bằng mô hình con lắc ngược quay.
HVTH: Lê Quang Vũ Trang 4 Luan van Luận văn thạc sĩ GVHD: PGS.TS DƢƠNG HOÀI NGHĨA Phƣơng pháp thực nghiệm: Sử dụng phần mềm Matlab/Simulink mô phỏng trên máy tính: mô phỏng con lắc ngược với các phương trình toán học. Xây dựng mô hình thực tế hệ thống, dùng DSP TMS320F28335 để thu thập dữ liệu và điều khiển hệ thống thực tế đã xây dựng được. Đánh giá kết quả dựa trên mô phỏng và thực nghiệm. Cấu trúc của luận văn Luận văn tìm hiểu cơ sở lý thuyết của điều khiển trượt để điều khiển cân bằng hệ con lắc ngược, lập trình, mô phỏng trên phần mềm Matlab và thực hiện thi công mô hình phần cứng.
Sau đó, học viên sẽ thực hiện nhúng giải thuật điều khiển trên DSP TMS320F28335 để áp dụng điều khiển mô hình lắc ngược quay thực tế. Luận văn gồm 7 chương với nội dung cụ thể như sau: Chƣơng 1: Tổng quan Giới thiệu tổng quan nhằm mục đích giới thiệu đề tài, các vấn đề mà đề tài cần giải quyết, công trình liên quan, mục tiêu nghiên cứu, phạm vi nghiên cứu và phương pháp nghiên cứu của học viên. Chƣơng 2: Mô hình hóa và tham số Khảo sát đối tượng con lắc ngược, trình bày việc phân tích mô hình toán học hệ con lắc ngược. Xác định các thông số toán học của đối tượng, các biến trạng thái.
Chƣơng 3: Giải thuật điều khiển Trình bày sơ lược về cơ sở lý thuyết về điều khiển trượt. Chƣơng 4: Giới thiệu phần cứng Chương này trình bày phần cơ khí, điện và chương trình mà học viên thực hiện cho hệ con lắc ngược. HVTH: Lê Quang Vũ Trang 5 Luan van Luận văn thạc sĩ GVHD: PGS.TS DƢƠNG HOÀI NGHĨA Chƣơng 5: Kết quả mô phỏng Chương này trình bày cách đưa mô hình toán học của hệ con lắc ngược vào mô phỏng bằng Matlab. Kết quả mô phỏng của hệ thống.
Chƣơng 6: Kết quả trên mô hình thực Trình bày kết quả điều khiển thực tế cho thiết kế phần cứng ở chương trước. Đánh giá và nhận xét về chất lượng điều khiển. Chƣơng 7: Kết luận và hƣớng phát triển Kết luận tóm tắt về kết quả đã đạt được cũng như những hạn chế và hướng phát triển để hoàn thiện hơn những thiếu sót của đề tài. HVTH: Lê Quang Vũ Trang 6 Luan van Luận văn thạc sĩ GVHD: PGS.TS DƢƠNG HOÀI NGHĨA Chƣơng 2 MÔ HÌNH HÓA VÀ THAM SỐ Chương này sẽ trình bày cách xây dựng mô hình toán học của hệ con lắc ngược và cơ sở giải thuật áp dụng để điều khiển đối tượng trong đề tài.
Giới thiệu sơ lƣợc về hệ thống con lắc ngƣợc quay Hệ thống con lắc ngược là một vấn đề điều khiển cổ điển nó được sử dụng trong các trường đại học trên khắp thế giới. Hệ thống con lắc ngược là mô hình phù hợp để kiểm tra các thuật toán điều khiển hệ phi tuyến cao trở lại ổn định. Đây là một hệ thống SIMO điển hình vì chỉ gồm một ngõ vào là điện áp cấp cho động cơ (hoặc lực quay của động cơ) mà phải điều khiển cả vị trí cánh tay quay và góc lệch con lắc ngược sao cho thẳng đứng (hai ngõ ra). Ngoài ra, phương trình toán học được đề cập đến của con lắc ngược mang tính chất phi tuyến điển hình.
Đối tượng con lắc ngược lại có kết cấu cơ khí không phức tạp để có thể chế tạo. Vì thế, đây là một mô hình lý tưởng cho các phòng thí nghiệm Điều khiển tự động. Mô hình hệ thống con lắc ngược quay gồm hai phần: cánh tay gắn vào động cơ DC quay quanh trục thẳng đứng và con lắc gắn vào trục encoder ở cuối cánh tay tự do trong mặt phẳng vuông góc với cánh tay được thể hiện ở Hình 2. Con lắc không ổn định, nó luôn ngã xuống trừ khi có lực tác động thích hợp vào cánh tay.
Bài toán đặt ra là điều khiển cánh tay để giữ cho con lắc cân bằng ở vị trí thẳng đứng. Con lắc ổn định nhờ bộ điều khiển trượt. HVTH: Lê Quang Vũ Trang 7 Luan van Luận văn thạc sĩ GVHD: PGS.TS DƢƠNG HOÀI NGHĨA Hình 2.1 Sơ đồ khối mô hình con lắc ngƣợc đƣợc thực hiện ở luận văn Mô hình mô phỏng được dựa theo phương trình động lực học của hệ thống con lắc ngược quay. Đồng thời bộ điều khiển cơ bản cũng sẽ được trình bày trong phần tiếp theo của chương này.
Mục đích của việc trình bày con lắc ngược trong mô phỏng là để kiểm chứng lại lý thuyết từ các mô hình toán. Từ đó có thể đánh giá sự ổn định của hệ thống con lắc ngược quay trong lí thuyết.