BỘ GIÁO DỤC VÀ ĐÀO TẠO BỘ QUỐC PHÒNG VIỆN KHOA HỌC VÀ CÔNG NGHỆ QUÂN SỰ
Trần Ngọc Bình
TỔNG HỢP BỘ ĐIỀU KHIỂN PHI TUYẾN CHO HỆ TRUYỀN ĐỘNG BÁM PHÁO PHÒNG KHÔNG TẦM THẤP CHỊU TÁC ĐỘNG CỦA NHIỄU ĐỘT BIẾN
TÓM TẮT LUẬN ÁN TIẾN SỸ KỸ THUẬT
Chuyên ngành: Kỹ thuật điều khiển và tự động hóa Mã số: 62 52 02 16
Hà Nội - 2018
Công trình được hoàn thành tại:
VIỆN KHOA HỌC VÀ CÔNG NGHỆ QUÂN SỰ - BỘ QUỐC PHÒNG
Người hướng dẫn khoa học:
GS – TSKH CAO TIẾN HUỲNH PGS – TS NGUYỄN VŨ
Đại học Bách khoa Hà nội
Học viện Kỹ thuật Quân sự
Phản biện 1: GS – TS NGUYỄN DOÃN PHƯỚC Phản biện 2: PGS – TS PHẠM TRUNG DŨNG Phản biện 3: PGS – TS BÙI XUÂN KHOA
Học viện Phòng không - Không quân
Thư viện Viện Khoa học và Công nghệ quân sự Thư viện quốc gia Việt Nam
Luận án này được bảo vệ trước Hội đồng chấm luận án Tiến sĩ cấp Viện họp tại Viện Khoa học và Công nghệ quân sự vào hồi …… giờ ngày …… tháng ….. năm 2018 Có thể tìm hiểu luận án tại:
1
MỞ ĐẦU
1. Đặt vấn đề
Trong tình hình hiện nay, để nâng cao tiềm lực quân sự, hiện đại hóa vũ khí trang bị kỹ thuật, quân đội ta vừa tiến hành mua sắm vũ khí hiện đại vừa cải tiến nâng cấp vũ khí hiện có, đồng thời nghiên cứu chế tạo mới các loại vũ khí khí tài. Chủ trương này đã phát huy hiệu quả trong nhiều lĩnh vực, đặc biệt là trong lĩnh vực phòng không tầm thấp.
Nhằm nâng cao khả năng tiêu diệt các mục tiêu bay thấp và cực thấp, các hệ thống pháo phòng không tầm thấp đã được cải tiến, nâng cấp, chế tạo bổ xung các hệ thống trinh sát quang điện tử và điều khiển trung tâm để hệ thống có khả năng tác chiến cả ban ngày và ban đêm. Tuy nhiên chủ yếu vẫn là bán tự động, thao tác trực tiếp trên pháo để bám sát và bắn mục tiêu bay theo chỉ thị từ trung tâm điều khiển vẫn do pháo thủ đảm nhiệm. Cũng đã có nhiều nghiên cứu đi theo hướng thay thế con người bằng hệ thống truyền động tự động, nhưng chưa có kết quả hoàn chỉnh với các nghiên cứu toàn diện cho một đối tượng cụ thể.
Việc đưa hệ thống truyền động tự động vào điều khiển pháo sẽ nâng cao độ chính xác, độ tác động nhanh của hệ thống vũ khí, nâng cao khả năng tiêu diệt các mục tiêu bay thấp, tốc độ cao. Đặc biệt là giảm được số pháo thủ thao tác trực tiếp trên pháo sẽ giảm được thương vong khi chiến tranh xảy ra. Mặt khác, muốn nâng cao khả năng cơ động, hệ thống PPK phải giảm được thời gian chuẩn bị sẵn sàng chiến đấu đồng thời đảm bảo khả năng bắn trúng mục tiêu ngay khi không có thời gian hiệu chỉnh pháo theo các phương pháp truyền thống. Chính từ những lý do nêu trên, Luận án đã đặt ra mục tiêu và nội dung nghiên cứu là:
2. Mục tiêu nghiên cứu
Mục tiêu của luận án là nghiên cứu xây dựng phương pháp tổng hợp bộ điều khiển bám theo đầu vào bất định cho một lớp đối tượng cơ điện (ở đây là hệ điều khiển hỏa lực) trên nguyên lý chủ động, đảm bảo các chỉ tiêu chất lượng, đáp ứng yêu cầu tiêu diệt mục tiêu bay trong chiến tranh công nghệ cao. Trên cơ sở đó tổng hợp hệ thống điều khiển truyền động tự động cho pháo PPK ZU23mm-2N đáp ứng yêu cầu của thực tiễn.
3. Đối tượng nghiên cứu
2
Hệ thống tự động điều khiển hỏa lực cho PPK cải tiến với hệ thống truyền động bám cơ điện đang sử dụng trong Quân đội. Đối tượng cụ thể để thực thi thuật toán tổng hợp là hệ truyền động điện của PPK ZU23mm-2N cải tiến.
4. Phạm vi nghiên cứu
Nghiên cứu các phương pháp phân tích và tổng hợp hệ thống cũng như các giải pháp đảm bảo chất lượng điều khiển bám loại trừ được ảnh hưởng của nhiễu và các đặc tính phi tuyến của thiết bị trong hệ thống, đặc biệt là những nhiễu đột biến sinh ra trong lúc bắn. Trên cơ sở đó luận án xây dựng một phương pháp tổng hợp bộ điều khiển phi tuyến cho một lớp đối tượng cơ điện có 2 kênh điều khiển tà và phương vị ứng dụng trong bài toán điều khiển bắn đón các mục tiêu di động.
5. Nội dung nghiên cứu - Xây dựng mô hình toán học mô tả động học của một lớp đối tượng điều khiển. - Xây dựng thuật toán xác định giá trị đầu vào cho hệ điều khiển truyền động bám trong điều kiện đặt vũ khí phi tiêu chuẩn.
- Xây dựng phương pháp tổng hợp hệ thống điều khiển bền vững, bù trừ và giảm thiểu ảnh hưởng của các thành phần nhiễu tác động lên hệ thống, kể cả nhiễu đột biến không trơn, trên cơ sở nhận dạng nhiễu phi tuyến và kỹ thuật điều khiển trượt, làm cơ sở cho việc thiết kế chế tạo các bộ điều khiển bám trong hệ thống cơ điện đảm bảo các chỉ tiêu chất lượng theo yêu cầu
6. Phương pháp nghiên cứu
Luận án sử dụng phương pháp phân tích, tổng hợp và vận dụng các lý thuyết điều khiển hiện đại. Để kiểm chứng luận án sử dụng công cụ matlab- simulink và ứng dụng một phần kết quả nghiên cứu cho PPK Zu23mm-2N cải tiến.
7. Ý nghĩa khoa học và thực tiễn
Nội dung nghiên cứu của luận án làm phong phú thêm về mặt phương pháp xử lý số liệu và tổng hợp thuật toán điều khiển cho một lớp đối tượng cơ điện điển hình. Các phương pháp đề xuất và các thuật toán thu được có thể phục vụ trực tiếp cho việc tổng hợp, thiết kế chế tạo mới và cải tiến nâng cao chất lượng cho các hệ thống bám trong quân sự và trong công nghiệp. Kết quả mô phỏng và ứng dụng thực tế đã chứng minh tính đúng đắn, cho thấy hiệu quả của nội dung nghiên cứu.
Chương 1
3
TỔNG QUAN VỀ ĐIỀU KHIỂN TRUYỀN ĐỘNG BÁM CHO MỘT LỚP ĐỐI TƯỢNG CƠ ĐIỆN TRONG HỆ THỐNG ĐIỀU KHIỂN HỎA LỰC PHÁO PHÒNG KHÔNG TẦM THẤP 1.1.Giới thiệu một số hệ điều khiển hỏa lực phòng không tầm thấp:
Những hệ thống pháo phòng không tầm thấp thường được trang bị hệ thống quang điện tử kết hợp với ra đa để sục xạo xác định mục tiêu, hệ thống máy tính điều khiển hỏa lực và hệ thống truyền động tự động cho thiết bị trinh sát và cho hỏa lực. Các tổ hợp PPK này thường được tích hợp trên phương tiện cơ động. Một số tổ hợp PPK hiện đại trên thế giới được trình bày trong luận án như: Tổ hợp PPK MANTIS (Đức); Tổ hợp PPK Porcupine (Italia); Tổ hợp PPK RAPIDFire (Châu Âu).
Nhận xét: Các hệ thống hỏa lực phòng không tầm thấp trên thế giới xây dựng theo xu thế này đã được giới thiệu với các tính năng ưu việt cùng với khả năng bắn chính xác tiêu diệt mục tiêu ngay từ loạt đạn đầu với độ ổn định cao. Tuy nhiên phương thức điều khiển và các thuật toán điều khiển đều không được công bố.
Ở trong nước, các hệ thống điều khiển hỏa lực PPK được quân đội ta nghiên cứu và phát triển từ những năm 1993 đến nay, điển hình của hệ thống này là các trận địa PPK 37mm-2N tác chiến ngày và đêm do Viện TĐH- KTQS/Viện KHCNQS thiết kế chế tạo, hiện đã được đưa vào trang bị phục vụ sẵn sàng chiến đấu trong Quân đội [22]. Hệ thống bao gồm phân hệ trinh sát trên cơ sở quang điện tử, hệ thống điều khiển hỏa lực và hệ thống pháo điều khiển trực tiếp. Trong hệ thống này vũ khí chưa được tích hợp các hệ thống truyền động tự động. Các hệ thống truyền động tự động sau này được đưa vào cải tiến và lắp đặt cho PPK 14,5mm-4N và PPK Zu23mm-2N. Thuật toán điều khiển được xây dựng trên luật điều khiển PID. Một số vũ khí khác cũng được cải tiến để đưa lên phương tiện cơ động và đưa xuống tàu hải quân, tuy nhiên chưa giải quyết hết các vấn đề điều khiển truyền động tự động bám. 1.2. Các yếu tố ảnh hưởng đến độ chính xác bắn trong điều khiển hỏa lực:
4
Từ khi viên đạn chuyển động trong nòng cho đến khi bay đến mục tiêu, đặc biệt khi mục tiêu di động, viên đạn chịu nhiều tác động, ảnh hưởng đến độ chính xác của nó. Trong đó chủ yếu là các yếu tố liên quan đến cấu trúc vật lý, môi trường, khí tượng:
- Kết cấu của súng pháo và nền đặt bắn; - Kết cấu của đạn; - Ảnh hưởng của hệ chỉ thị mục tiêu; - Ảnh hưởng của môi trường, khí tượng; Và một số vấn đề nảy sinh như sau:
- Vấn đề nảy sinh khi điều khiển hỏa lực trên mặt phẳng nghiêng; - Vấn đề nảy sinh khi điều khiển hỏa lực trong lúc bắn. Các vấn đề này đều phải tính đến trong quá trình tổng hợp các hệ điều khiển hỏa lực.
1.3. Bài toán tự động điều khiển hỏa lực pháo phòng không tầm thấp: 1.3.1. Tổng quan phương pháp điều khiển truyền động bám:
Các hệ thống truyền động có mặt rộng rãi trong các hệ thống vũ khí khí tài. Đối với vũ khí khi không có điều khiển, đòi hỏi về độ chính xác của đường ngắm thường rất cao. Để đảm bảo được điều đó, đặc biệt khi mục tiêu di động, các hệ thống vũ khí cần phải được tích hợp các hệ thống điều khiển truyền động.
Các hệ thống điều khiển truyền động thường là các hệ thống bất định, chịu tác động của nhiễu và yêu cầu có chất lượng điều khiển cao, bao gồm cả độ chính xác, độ bền vững và tác động nhanh. Để đảm bảo chất lượng cho các hệ thống với đặc tính như vậy, nhiều công trình nghiên cứu đã được thực hiện như sử dụng bộ nhận dạng thích nghi trên cơ sở mạng nơ ron xuyên tâm để tổng hợp hệ thống điều khiển hoạt động trong chế độ trượt cho lớp đối tượng phi tuyến phụ thuộc đầu ra hoạt động trong điều kiện có nhiễu tác động; sử dụng mặt trượt cận tối ưu trong tổng hợp hệ thống tự động bám để nâng cao khả năng tác động nhanh cho hệ thống. Tuy nhiên, trong thực tế một số đối tượng điều khiển có mô hình không rõ ràng đồng thời nhiễu tác động vào hệ thống còn chứa các thành phần phi tuyến bất định, với các nhiễu đột biến. Việc áp dụng các kết quả đã nêu cho lớp đối tượng này là khó thực hiện.
5
Để khắc phục những khó khăn đó một số công trình đề xuất sử dụng điều khiển bền vững và điều khiển thích nghi, trong đó nổi bật là điều khiển trượt. Trong mọi trường hợp, yêu cầu chung đối với các hệ thống cần đạt được là: Tính chính xác và tốc độ đáp ứng của hệ thống; Tính thích nghi bền vững của hệ thống; Tính ổn định của hệ thống.
Cho đến nay vẫn chưa có phương pháp tổng hợp hệ thống đáp ứng đầy đủ các yêu cầu nêu trên. Rõ ràng, xây dựng phương pháp tổng hợp, thiết kế, chế tạo hệ thống tự động bám đáp ứng tối đa các yêu cầu trên thực sự là bức thiết.
1.3.2. Hệ truyền động cơ điện trong điều khiển hỏa lực:
Các hệ thống vũ khí điều khiển tự động thường được sử dụng hai chuyển động chủ yếu bao gồm chuyển động quay theo góc tà (𝜀) và quay theo góc phương vị (𝛽). Bằng hai chuyển động này hệ thống sẽ điều khiển nòng pháo hướng vào một tọa độ đã định trước trong không gian. Các hệ truyền động cơ điện bao gồm hộp số, động cơ, khối khuyếch đại công suất, khối điều khiển, khối đo lường, khối nhận và chuyển đổi tín hiệu đầu vào.
Các hệ thống truyền động điện này là các đối tượng cơ điện, được các nhà khoa học quan tâm nghiên cứu và phát triển [23]. Các công trình này được chia thành 2 nhóm:
Nhóm thứ nhất: Các công trình đơn thuần về truyền động điện, có nghĩa là làm sao tạo ra trên đầu trục cơ cấu chấp hành (CCCH) lượng điều khiển mô men theo yêu cầu [22], [51], [68].
Nhóm thứ hai: Sử dụng kết quả của nhóm thứ nhất điều khiển các hệ thống cơ học phức tạp, với tín hiệu đầu vào là mô men điều khiển cho mô hình động học được mô tả bằng phương trình Euler-Lagrange (1.1): (1.1)
𝐵(𝑞)𝑞̈ + 𝐶(𝑞, 𝑞̇ )𝑞̇ + 𝐺(𝑞) + 𝜙(𝑞̇ ) + 𝑡 = 𝜏 Điều khiển các hệ cơ học với mô hình động học (1.1) đã trở thành một vấn đề được quan tâm nhiều trong thời gian gần đây. Nhiều thuật toán điều khiển được đề xuất cho các hệ thống này dựa trên mô hình lý tưởng, không tính đến sự bất định của tham số mô hình, nhiễu loạn bên ngoài hay thành phần lực ma sát. Ngoài ra, các thuật toán này còn dựa trên giả thiết rằng toàn bộ biến trạng thái của hệ thống đều được biết [63], [75], [79]. Trong thực tế, vị trí thường là biến có thể dễ dàng đo được, còn các biến khác cần phải có những phương tiện đo bổ sung mà không phải khi nào cũng đo được, và kết
6
quả đo thường đi liền với những sai số nhất định. Chính vì vậy, để ứng dụng vào một lĩnh vực cụ thể cần những nghiên cứu chuyên sâu hơn. 1.4. Đặt bài toán:
Các hệ thống PPK tầm thấp là vũ khí không có điều khiển và phải bắn mục tiêu di động. Trong quá trình đạn bay, mục tiêu cũng chuyển động nên đường bắn của pháo phòng không phải là đường ngắm về phía mục tiêu và là một đường được tính toán trong không gian, hường về một điểm trong không gian, phụ thuộc vào các tham số của mục tiêu sao cho trong khoảng thời gian t đạn bay, đạn và mục tiêu sẽ gặp nhau tại một điểm. Nếu góc trong hệ tọa độ cầu với tâm là tâm pháo đến mục tiều là 𝛽(𝑡) và 𝛼(𝑡) thì góc của nòng pháo hay góc của đường bắn phải là 𝛽(𝑡) + 𝜑(𝑡) và 𝛼(𝑡) + 𝜀(𝑡) trong đó 𝜑(𝑡) là góc bắn đón, 𝜀(𝑡) là góc nâng và luôn cần tính toán. Một số yêu cầu cơ bản của các hệ thống điều khiển hỏa lực PPK TT như sau: - Phải có độ chính xác cao, bám chính xác theo tham số mục tiêu, phải có độ tác động nhanh tốt,
- Phải có khả năng xác định nhanh các tham số đầu vào cho hệ điều khiển, đảm bảo ổn định hướng của trục nòng trong lúc bắn cũng như sau bắn ngay cả khi bệ đặt hỏa lực bị nghiêng so với mặt phẳng nằm ngang. - Hệ thống phải thích nghi, bền vững, giữ được chất lượng điều khiển ngay cả trong các trường hợp tham số của hệ thống bị thay đổi. Để đáp ứng các yêu cầu nêu trên, luận án định hướng theo các nhóm nội dung học thuật trọng tâm sau đây: 1) Giảm thiểu ảnh hưởng của các đặc tính phi tuyến đến chất lượng của hệ thống bằng cách bù trừ phi tuyến. 2) Xây dựng phương pháp xác định góc trục nòng pháo trong bám mục tiêu di động ngay cả trong trường hợp bệ đặt hỏa lực nghiêng.
3) Xây dựng phương pháp tổng hợp hệ điều khiển bám có các yếu tố phi tuyến phức tạp, bất định, đảm bảo cho hệ thống có chất lượng cao, có độ tác động nhanh tốt, có tính kháng nhiễu cao.
Kết luận chương 1: Qua nghiên cứu tổng quan chương 1 đã nêu rõ định hướng của luận án là: Xây dựng phương pháp tính toán bù góc nghiêng cho hệ hỏa lực khi bắn; Xây dựng mô hình toán học mô tả đầy đủ động học của hệ điều khiển hỏa lực. Trên cơ sở đó tổng hợp hệ thống điều khiển bám có chất lượng cao có tính đến tính phi tuyến bất định và nhiễu với yêu cầu phải đảm bảo được khả năng thích nghi, khả năng kháng nhiễu, đồng thời đảm bảo được tối ưu tác động nhanh, làm cơ sở cho việc xây dựng các hệ thống tự động điều khiển hỏa lực bắn mục tiêu di động có chất lượng cao.
7
Chương 2 XÂY DỰNG THUẬT TOÁN XÁC ĐỊNH GIÁ TRỊ ĐẦU VÀO CHO HỆ ĐIỀU KHIỂN TRUYỀN ĐỘNG BÁM TRONG HỆ ĐIỀU KHIỂN HỎA LỰC Để hệ truyền động có thể hoạt động với chất lượng cao, cần phải cung cấp đủ các thông tin đầu vào cho các hệ điều khiển truyền động này.
2.1 Sơ lược về tính toán phần tử bắn
Khi viên đạn chuyển động trong không khí, nó chịu tác động của cả lực cản và lực trọng trường, chính vì vậy, để viên đạn bay đến một điểm định trước cần được tính toán thông qua tam giác đường đạn và tam giác bắn đón (hình 2.1).
Hình 2.1 Hình 2.3
Các góc 𝜑𝑦 và 𝜀𝑦 là góc bắn đón và góc đường đạn. Việc xác định chính xác góc bắn đón mục tiêu di động của pháo cần thông qua bảng bắn cùng với cách tính phần tử bắn theo phương pháp nhích dần (hình 2.3 ).
2.2 Các hệ tọa độ và chuyển hệ tọa độ
Trong các điều kiện phi tiêu chuẩn, cần định nghĩa các hệ tọa độ để chuyển đổi các tham số của điểm bắn đón tính theo đài quan sát trong hệ tọa độ chuẩn đến các góc quay theo kênh phương vị và kênh tà của pháo.
2.2.1 Hệ tọa độ chuẩn
Hệ tọa độ chuẩn (hệ tọa độ mặt đất) có tâm 𝑂 nằm ở tâm quay của pháo, trục 𝑂𝑋𝑔 hướng về phía bắc theo phương nằm ngang, trục 𝑂𝑍𝑔 hướng về phía
8
đông theo phương nằm ngang còn trục 𝑂𝑌𝑔 vuông góc với mặt phẳng 𝑂𝑋𝑔𝑍𝑔 và tạo với các trục 𝑂𝑋𝑔, 𝑂𝑍𝑔 một tam diện thuận (hình 2.4). 2.2.2 Hệ tọa độ đế pháo, hệ tọa độ mâm pháo và hệ tọa độ nòng pháo
2.2.2.1 Hệ tọa độ đế pháo Hệ tọa độ đế pháo được biểu diễn trên hình 2.4.
2.2.2.2 Hệ tọa độ mâm pháo và hệ tọa độ nòng pháo
Hệ tọa độ mâm pháo và hệ tọa độ nòng pháo được xây dựng để có thể xác định được góc phương vị và góc tà của pháo trong hệ tọa độ chuẩn theo các góc quay theo 2 trục của pháo.
2.2.3 Góc quay giữa các hệ tọa độ
Các góc Ơle thể hiện phép quay giữa hệ tọa độ đế pháo 𝑂𝑋𝑑𝑌𝑑𝑍𝑑 so với hệ tọa độ mặt đất 𝑂𝑋𝑔𝑌𝑔𝑍𝑔 được xác định bằng các sensor gắn trên mâm pháo. Góc 𝜓 là số bù của la bàn điện tử, 𝜐 và 𝜒 là giá trị góc nghiên do sensor đo nghiêng đưa ra.
Góc quay của hệ tọa độ mâm pháo 𝑂𝑋𝑚𝑌𝑚𝑍𝑚 so với hệ tọa độ đế pháo là góc của hệ truyền động phương vị, ký hiệu là 𝛽𝑝.
Góc quay của hệ tọa độ nòng pháo 𝑂𝑋𝑛𝑌𝑛𝑍𝑛 so với hệ tọa độ mâm pháo 𝑂𝑋𝑚𝑌𝑚𝑍𝑚 là góc được xác định bằng cách gắn cảm biến đo góc (encoder) lên trục quay của hệ truyền động tà, ký hiệu là 𝑝. Như vậy, về mặt tổng quát, vị trí của nòng pháo trong hệ tọa độ mặt
đất được xác định bằng 5 góc quay 𝑝, 𝛽𝑝, 𝜓, 𝜐, 𝜒.
2.3 Xác định góc pháo trong hệ tọa độ đế pháo
2.3.1 Thuật toán bù nghiêng cho nòng pháo
Để tính toán và điều khiển chính xác cho hệ hỏa lực cần xác định và bù trừ các thành phần do đế pháo bị nghiêng. Việc sử dụng sensor đo nghiêng và la bàn điện tử sẽ cho phép giải quyết nhiệm vụ định hướng cho đường ngắm theo phương nằm ngang, còn việc bù độ nghiêng cho các góc tà và góc
9
(2.12a) phương vị ở vị trí bất kỳ sẽ được thực hiện nhờ thuật toán bù nghiêng khi có tham số mục tiêu trong hệ tọa độ chuẩn 𝛽0 & 0 theo các thuật toán: 𝑎11 = 𝑐𝜃1𝑐𝜃2𝑐𝛽0𝑐0 + 𝑐𝜃1𝑠𝜃2 𝑐𝜃3𝑠0 − 𝑠𝜃2𝑠𝜃3𝑠0 +
𝑐𝜃1𝑠𝜃2𝑠𝜃3𝑠𝛽0𝑐0 − 𝑠𝜃1𝑐𝜃3𝑠𝛽0𝑐0 𝑎12 = −𝑠𝜃2𝑐𝛽0𝑐0 − 𝑐𝜃2 𝑐𝜃3𝑠0 + 𝑐𝜃2𝑠𝜃3𝑠𝛽0𝑐0 𝑎13 = 𝑠𝜃1𝑐𝜃2𝑐𝛽0𝑐0 − 𝑠𝜃1𝑠𝜃2 𝑐𝜃3𝑠0 + 𝑐𝜃1𝑠𝜃3𝑠0 + 𝑠𝜃1𝑠𝜃2𝑠𝜃3𝑠𝛽0𝑐0 + 𝑐𝜃1𝑐𝜃3𝑠𝛽0𝑐0
𝑎13 𝑎11
(2.12b) )
𝛽𝑝 = 𝑎𝑟𝑐𝑡𝑔 ( { 𝑝 = 𝑎𝑟𝑐𝑠𝑖𝑛(−𝑎12) Khi 𝑎11 = 0 thì 𝛽𝑝 có hai giá trị phụ thuộc vào góc 𝜃1và 𝛽0 là:
(2.12c) 𝛽𝑝 = { 900 𝑛ế𝑢 0 < 𝜃1 + 𝛽0 < 1800 2700 𝑛ế𝑢 1800 < 𝜃1 + 𝛽0 < 3600
Thuật toán bù nghiêng được biểu diễn theo các bước như sau: - Bước 1: Xác định các góc quay Ơle 𝜃1, 𝜃2, 𝜃3 từ các cảm biến đo nghiêng và la bàn điện tử lần lượt theo (2.5), (2.6) và (2.10);
- Bước 2: Tính 𝑇𝑑−𝑔 theo (2.2); - Bước 3: Tính 𝑇𝑛−𝑔 theo (2.11); - Bước 4: Tính 𝑇𝑛−𝑑 theo (2.12) có các phần tử theo (2.12a); - Bước 5: Tính góc pháo đã bù nghiêng theo (2.12b) và (2.12c).
2.3.2 Mô phỏng thuật toán bù nghiêng và so sánh thực nghiệm
Hệ thống thực nghiệm là pháo ZU23mm-2N. Việc tính toán xác định góc nghiêng của bệ pháo thông qua thuật toán bù nghiêng khi biết các góc 𝜓, 𝜒, 𝜐 ban đầu và so sánh với góc nghiêng đo được từ các đầu đo gắn trên bệ quay của pháo ZU23mm-2N. Thiết bị sử dụng đo để đo góc nghiêng là loại cảm biến đo nghiêng hai trục HCA-526T có sai số 0,015 độ được gắn tại tâm quay của bệ phương vị; mô đun la bàn điện tử với sai số 0,1 độ. Kết quả tính toán và thực nghiệm được trình bày trong bảng 2.1.
Như vậy, bằng phương pháp bổ sung các sensor đo hướng và đo góc nghiêng cho đế pháo, sử dụng ma trận DCM để xác định các góc Ơle, việc xác định góc tà và góc phương vị của pháo khi góc của trục nòng pháo là góc cho trước trong hệ tọa độ đế pháo đã được thực hiện. Điều này cho phép triển khai hệ thống điều khiển hỏa lực một cách nhanh chóng.
10
𝜒𝑡𝑡
𝜐𝑇𝐿
𝜒đ𝑜
𝜒𝑇𝐿
𝜐đ𝑜 0,690 0,030 0,630
𝜐𝑡𝑡 0,680 −1,560 0,030 −1,700 0,620 −1,580
𝛽0 0,00 22,50 45,00 67,50 89,00 −22,50 250 −1,560 0,680 1,180 −45,00 250 −1,560 0,680 −0,620 0,030 −67,50 250 −1,560 0,680 0,650 −89,00 250 −1,560 0,680
0 250 −1,560 0,680 −1,560 250 −1,560 0,680 −1,700 250 −1,560 0,680 −1,580 250 −1,560 0,680 −1,230 −1,180 −1,210 −1,1920 250 −1,560 0,680 −1,550 −0,710 −1,560 −0.690 1,240 1,590 1,700 1,560
1,230 −1,170 1,580 −0,600 1,700 −0,060 0,670 1,570
𝑝 𝛽𝑝 25,20 −0,000 26,70 22,470 26,580 45,290 28,220 68,050 89,720 25,690 −23,100 26,170 −45,750 25,610 −68,290 24,950 −89,720 24,330 Số liệu trong bảng 2.1 cho thấy , sai số giữa các góc tính toán mô
Bảng 2.1: Bảng số liệu tính toán và thực nghiệm cho ZU23mm-2N
phỏng và đo lường thực tế nhỏ (≤ 0.5 li giác ) 2.4. Phương pháp xác định tham số đầu vào cho hệ điều khiển bám của các khẩu đội pháo phòng không
Đối với các hệ thống điều khiển bám tự động, để đảm bảo chất lượng điều khiển, giá trị vị trí góc là chưa đủ mà cần thêm giá trị vận tốc góc và gia tốc góc của từng kênh điều khiển. Nếu giá trị vận tốc góc và gia tốc góc được xác định bằng việc lấy đạo hàm bậc 1 và bậc 2 của giá trị phần tử bắn sẽ dẫn tới có các sai số và nhiễu loạn. Chính vì vậy cần xây dựng phương pháp xác định các giá trị này một cách trực tiếp, tính toán dựa trên các số liệu đo lường. 2.4.1. Xác định các tham số chuyển động của mục tiêu
Các tham số chuyển động của mục tiêu được xác định sau khi đo cự ly mục tiêu và góc đường ngắm tới mục tiêu tại các thời điểm t1 và t2 [19], với giả thiết là mục tiêu bay bằng với vận tốc không đổi như biểu diễn trên hình 2.7.
Hình 2.7: Sơ đồ xác định các tham số chuyển động của mục tiêu Để hệ điều khiển pháo đạt chất lượng cao, cần xác định vận tốc góc và gia tốc góc của mục tiêu theo kênh phương vị (𝜑̇ , 𝜑̈ ) và kênh tà (𝜀̇, 𝜀̈).
11
Từ (2.20):
(2.20a) 𝜑̇ = −𝛽̇ và 𝜑̈ = −𝛽̈
* Xác định vận tốc góc và gia tốc góc theo kênh phương vị: Ta chiếu vecto tốc độ 𝜗⃗ xuống mặt phẳng 𝑥𝑂𝑧, được vecto 𝑢⃗⃗. Vì mục tiêu bay bằng nên |𝑢| = |𝜗|.
Chiếu vecto 𝑢⃗⃗ lên đường vuông góc với 𝑂𝑀𝑔 được vecto 𝓋⃗⃗⃗ ta có: (2.21) |𝓋| = |𝜗|𝑐𝑜𝑠𝛽
Hình 2.8: Sơ đồ xác định các tham số tốc độ góc và gia tốc góc
(2.22) Như vậy, tốc độ góc phương vị được xác định như sau:
Mặt khác 𝑑 = 𝜌 ⁄ 𝑐𝑜𝑠𝛽
𝛽̇ = (|𝜗|/𝑑)𝑐𝑜𝑠𝛽 , nên (2.22) trở thành: |𝛽|̇ = (|𝜗|/𝜌)𝑐𝑜𝑠2𝛽
(2.23) Dấu của 𝛽̇ được xác định theo hướng bay, nếu 𝜑2 > 𝜑1 thì 𝛽̇ < 0; nếu 𝜑2 < 𝜑1 thì 𝛽̇ > 0. Đối với trường hợp như trên hình 2.8 ta có 𝛽̇ > 0 nên: 𝛽̇ = (|𝜗|/𝜌)𝑐𝑜𝑠2𝛽 (2.24)
(2.26) 𝛽̈ = − Từ (2.24) xác định gia tốc góc: |𝜗|2 𝜌2 (𝑠𝑖𝑛2𝛽)𝛽̇
* Xác định vận tốc góc và gia tốc góc theo kênh tà: Để giải bài toán này, từ 𝑀 kẻ đường thẳng 𝑀𝑏 song song với đường
𝑂𝑀𝑔 chiếu vecto vận tốc 𝜗⃗ lên đường này, ta nhận được vecto vận tốc 𝜔⃗⃗⃗. Từ 𝑀 kẻ đường 𝑀𝐶 vuông góc với 𝑂𝑀, nằm trong mặt phẳng thẳng
đứng đi qua OM chiếu vecto 𝜔⃗⃗⃗ lên đường 𝑀𝐶 ta được véc tơ 𝜃⃗. Đặt:
12
(2.27) 𝜀̅ = − 𝜀 𝜋 2
Như vậy, vận tốc góc và gia tốc góc theo góc tà sẽ được xác định như sau: (2.33) 𝜀̇ = − . 𝑠𝑖𝑛𝛽. 𝑠𝑖𝑛2𝜀
𝜀̈ = − . 𝑠𝑖𝑛2𝜀. 𝑐𝑜𝑠3𝛽 − { |𝜗| ℎ 𝜗2 𝜌. ℎ 𝜗2 ℎ2 𝑠𝑖𝑛2𝛽. 𝑠𝑖𝑛2𝜀. 𝑠𝑖𝑛2𝜀
Từ (2.26), (2.24) và (2.20a) xác định vận tốc góc theo kênh phương vị: (2.34) . 𝑐𝑜𝑠2𝛽 𝜑̇ =
𝜑̈ = |𝜗| 𝜌 𝜗2 𝜌2 𝑐𝑜𝑠2𝛽. 𝑠𝑖𝑛2𝛽 { 2.4.2 Mô phỏng thuật toán
Giả sử mục tiêu bay vào trận địa với các tham số đo được tại thời điểm 𝑡1 = 0𝑠 và 𝑡2 = 1𝑠 lần lượt là: 𝒟1 = 1500𝑚; 𝜀1 = 11,5370; 𝜑1 = 106,10; 𝒟2 = 1300𝑚; 𝜀2 = 13,2880; 𝜑2 = 105,50. Sử dụng các công thức (2.13), 𝜗, 𝛽1 và 𝜌 ta xác định được bộ tham số gồm: ℎ = 300𝑚; 𝜗 = 200 𝑚/𝑠; 𝛽1 = 86,10; 𝜌 = 100𝑚. Tiến hành mô phỏng sự biến thiên của vận tốc góc và gia tốc góc của góc phương vị và góc tà theo cự ly. Kết quả mô phỏng được trình bày trên hình 2.9 và hình 2.10.
Hình 2.9: Sự phụ thuộc của vận tốc góc và gia tốc góc kênh phương vị theo cự ly đường đáy của mục tiêu
Hình 2.10: Sự phụ thuộc của vận tốc góc và gia tốc góc kênh tà theo cự ly đường đáy của mục tiêu
13
Kết luận chương 2:
Bằng các công cụ của hình học giải tích và phương pháp ma trận cosin định hướng, chương 2 đã xây dựng được phương pháp xác định tham số góc cho hai chuyển động quay của trục nòng pháo trong quá trình điều khiển bám của hệ hỏa lực với bộ tham số đầu vào từ trung tâm điều khiển ngay cả khi bệ hỏa lực không nằm trên mặt phẳng ngang chuẩn đồng thời cũng xây dựng được phương pháp xác định các giá trị vận tốc góc và gia tốc góc của pháo một cách trực tiếp. Các tham số này góp phần quan trọng nâng cao chất lượng các hệ thống truyền động của PPK.
Chương 3 XÂY DỰNG THUẬT TOÁN ĐIỀU KHIỂN TRƯỢT THÍCH NGHI BÙ CÁC THÀNH PHẦN PHI TUYẾN VÀ NHIỄU CHO MỘT LỚP ĐỐI TƯỢNG CƠ ĐIỆN TRONG HỆ TRUYỀN ĐỘNG BÁM
Trên đây, đặc tính phi tuyến, bất định và có nhiễu của các hệ thống hỏa lực đã được đề cập đến và phân tích kỹ. Trong chương này, vấn đề xây dựng một giải pháp tổng hợp bộ điều khiển phi tuyến cho lớp đối tượng cơ điện trong hệ thống điều khiển hỏa lực với đặc thù là các hệ truyền động có các tham số bất định trong miền được xác định, đồng thời chịu tác động của nhiễu bên ngoài, đặc biệt là trường hợp khi nhiễu là các hàm không trơn, có đột biệt như trong quá trình bắn của vũ khí nhằm nâng cao chất lượng của các hệ điều khiển này sẽ được trình bày.
3.1 Cấu trúc của hệ thống hỏa lực có điều khiển truyền động tự động Hình 3.1 thể hiện cấu trúc của hệ truyền động điện (đối tượng cơ điện điển hình) điều khiển hỏa lực rút gọn.
Hình 3.1: Sơ đồ cấu trúc hệ điều khiển hỏa lực phòng không cải tiến
14
3.2 Mô hình toán học của hệ truyền đồng điều khiển hỏa lực phòng không
(3.1)
Mô hình toán học đầy đủ của hệ truyền động pháo được mô tả: 𝐵 (𝑞) 𝑞̈ + 𝐶 (𝑞, 𝑞̇ ) 𝑞̇ + 𝐹𝑚𝑠(𝑞̇ ) + 𝐺 (𝑞) + 𝐷𝑡 = 𝜏 Ma trận quán tính 𝐵(𝑞)có thể phân tách thành 2 thành phần bao gồm thành phần xác định được 𝐵̅(𝑞) biểu thị quán tính trung bình của mỗi cơ cấu quay và ∆𝐵(𝑞) biểu thị thành phần phụ thuộc cấu hình của cơ cấu quay: (3.4) 𝐵 (𝑞) = 𝐵̅(𝑞) + ∆𝐵(𝑞)
Để tạo ra mô men điều khiển 𝜏𝑚, các hệ thống điều khiển sử dụng bộ điều khiển servo và động cơ đồng bộ ba pha đi kèm. Bộ điều khiển này sau khi hiệu chỉnh là một khâu quán tính, và trong trường hợp thực tế, hằng số thời gian rất nhỏ và có thể bỏ qua
Khi đó 𝜏𝑚 = 𝑘. 𝑢 và từ (3.5) nhận được hai phương trình, mô tả động học của cơ cấu theo kênh phương vị và kênh tà. Theo phương vị: (3.12) 𝐾ℎ𝑠(𝛽)−1𝐵̅𝛽(𝛽)𝐾ℎ𝑠(𝛽)−1𝛽̈𝑚 + 𝐹𝑀(𝛽)𝛽̇𝑚
= 𝐾(𝛽). 𝑢𝛽 − 𝐻1(𝛽̇, 𝛽̈) − 𝑁1(t)
Theo tà: (3.13) 𝐾ℎ𝑠()−1𝐵̅()𝐾ℎ𝑠()−1̈ 𝑚 + 𝐹𝑀()̇ 𝑚 = 𝐾(). 𝑢− 𝐻2 (̇,̈) − 𝑁2(t)
3.3 Xây dựng thuật toán điều khiển phi tuyến cho lớp đối tượng cơ điện bất định và chịu tác động của nhiễu đột biến. 3.3.1 Đặt bài toán. Giả sử động học của đối tượng điều khiển được mô tả bằng phương trình: (3.14) 𝑥̇1 = 𝑥2 { 𝑥̇2 = 𝑎1𝑥1 + 𝑎2𝑥2 + 𝑏𝑢 + 𝑓𝑁(𝑥1, 𝑥2) + 𝑑
Trong đó: 𝑥1 và 𝑥2 là các biến trạng thái; 𝑢 là tác động điều khiển; 𝑎1, 𝑎2, 𝑏 là các tham số đặc trưng cho động học của đối tượng điều khiển; 𝑓𝑁(𝑥1, 𝑥2) là nhiễu phụ thuộc trạng thái (state dependent disturbance), là hàm bất định không biết trước; 𝑑 là nhiễu bên ngoài tác động lên đối tượng.
Vấn đề đặt ra tiếp theo ở đây là xây dựng các thuật toán điều khiển cho đối tượng (3.14) khi 𝑓𝑁(. ) và 𝑑(𝑡) không phải là các hàm trơn và có thể có các đột biến. Để thuận cho việc trình bày, mô hình (3.14) được viết ở dạng:
15
(3.18) 𝑥̇ = 𝑨𝑥 + 𝑩𝑢 + 𝒇(∙)
Với: 𝒇(∙) = [ ]; 0 𝑓(∙) 3.3.2 Nhận dạng và đánh giá hàm nhiễu bất định có đột biến. Để có được đánh giá đối với hàm 𝑓(∙), chúng ta sử dụng mô hình mẫu mà động học của nó được mô tả bằng hệ phương trình (3.19). (3.19) 𝑥̇1𝑚 = 𝑥2𝑚 { 𝑥̇2𝑚 = 𝑎1𝑥1𝑚 + 𝑎2𝑥2𝑚 + 𝑏𝑢 Khi đó: (3.22) 𝑒̇ = 𝑨𝑒 + 𝒇(∙)
Và: 𝑓̂(∙) = 𝑒̇2 − 𝑎1𝑒1 − 𝑎2𝑒2
(3.23) 3.3.3 Xây dựng thuật toán điều khiển đảm bảo chế độ trượt và giảm rung cho hệ thống Dưới đây, luận án đề xuất một giải pháp mới nhằm giảm thiểu hiện tượng rung, đồng thời luôn đảm bảo sự tồn tại của chế độ trượt cho hệ thống.
(3.25) Chọn mặt trượt 𝑆 cho hệ (3.12) dưới dạng: 𝑆 = 𝑐1𝑥1 + 𝑥2 với 𝑐1 > 0 Luật điều khiển có dạng:
𝑈 = 𝑢𝑒𝑞 + 𝑢𝑏 − 𝐾𝑠𝑆 − 𝛿𝑠𝑖𝑔𝑛𝑆
(3.27) [(𝑐1 + 𝑎2)𝑥2 + 𝑎1𝑥1] 𝑢𝑒𝑞 = − (3.26) Trong đó: 𝑢𝑒𝑞 – điều khiển tương đương của hệ (3.17) khi chưa chú ý tới nhiễu; 𝑢𝑏 – lượng điều khiển bù nhiễu; 𝐾𝑠𝑆 – lượng bổ sung, tỷ lệ với độ lệch của hệ thống khỏi mặt trượt, thành phần này làm cho hệ thống tiến về mặt trượt nhanh mà không làm tăng độ dao động của hệ thống; 𝛿 > 0 là đại lượng sẽ được xác định dưới đây. Từ (3.17) và (3.25) ta có: 1 𝑏 Tín hiệu bù nhiễu được tạo ra trên cơ sở các đánh giá nhiễu (3.23): (3.28) 𝑢𝑏 = −𝐾𝑏𝑓̂(∙)
Định lý 3.1: Hệ thống phi tuyến bất định dưới tác động của nhiễu (3.17) với luật điều khiển (3.26) và thuật toán đánh giá nhiễu (3.23) sẽ hoạt động ở chế độ trượt trên mặt trượt 𝑆 = 0 khi thỏa mãn điều kiện (3.25):
16
(3.2 𝐾𝑏 = 𝑣ớ𝑖 𝐾𝑏 > 0 3) { 𝛿 > ; |∆|𝑚𝑎𝑥 𝑙à 𝑔𝑖á 𝑡𝑟ị 𝑙ớ𝑛 𝑛ℎấ𝑡 𝑐ủ𝑎 𝑠𝑎𝑖 𝑠ố 𝑛ℎậ𝑛 𝑑ạ𝑛𝑔 1 𝑏 |∆|𝑚𝑎𝑥 𝑏
Sơ đồ cấu trúc của hệ điều khiển sử dụng chế độ trượt cho lớp đối tượng phi tuyến bất định dưới tác động của nhiễu được thể hiện trên hình 3.4.
Hình 3.4: Sơ đồ cấu trúc hệ điều khiển sử dụng chế độ trượt cho đối tượng phi tuyến bất định dưới tác động của nhiễu bên ngoài 3.3.4 Mô phỏng đánh giá thuật toán
Việc mô phỏng đánh giá thuật toán được thực hiện với các hệ thống điều khiển truyền động sử dụng động cơ một chiều không chổi than (BLDC). Kết quả mô phỏng khẳng định hiệu quả của thuật toán đề xuất. 3.3.5. Điều kiện áp dụng
Để nhận dạng và đánh giá được nhiễu bất định, có đột biến cần xây dựng được mô hình đối tượng, khi đó điều kiện (3.20) phải thỏa mãn, có nghĩa là các ma trận đầu vào và ma trận trạng thái của đối tượng phải xác định. Đối với hệ truyền động theo góc phương vị của súng pháo, mô men quán tính tổng hợp theo góc phương vị được xác định theo công thức:
𝐽𝜀𝛽(𝜀) = 𝐽𝜀𝑥𝑠𝑖𝑛2𝜀 + 𝐽𝜀𝑦𝑐𝑜𝑠2𝜀 (3.36) Vì vậy ma trận đầu vào B trong hệ truyền động phương vị là ma trận có tham số thay đổi, nên để áp dụng Định lý 3.1 cần phải xây dựng được phương pháp xác định các tham số động học hay xác định ma trận đầu vào của hệ thống theo thời gian thực. 3.4 Thuật toán xác định các tham số động học của kênh phương vị Kênh phương vị là một kênh truyền động độc lập, có thể được mô tả bằng phương trình sau:
17
𝑝𝑣 = 𝑥̇1 𝑥2 𝑝𝑣 = −𝑘𝜔 𝑥̇2
𝑝𝑣 + 𝑏2
𝑝𝑣. 𝑥2
𝑝𝑣 𝑝𝑣. 𝑢𝑝𝑣 + 𝑓(∗)𝑝𝑣 Nếu biểu diễn lại mô tả toán học của hệ truyền động kênh phương vị
(3.37) {
dưới dạng phương trình trạng thái, từ (3.25) và (3.26), ta có: (3.39) ] 𝑨𝑝𝑣 = [ 1 0 𝑝𝑣]; 𝑩𝑝𝑣 = [ 0 −𝑘𝜔 0 1 𝐽𝛽+ 𝐽𝜀𝛽(𝜀) Để thuận lợi cho tính toán mô hình hệ thống, cần biểu thị 𝑩𝑝𝑣 dưới dạng:
0 𝑩𝑝𝑣 = 𝑘(𝜀). 𝑩̅ 𝑝𝑣; 𝑩̅ 𝑝𝑣 = [ ⁄ ] (3.40);(3.41) 1 𝐽𝛽
𝐽𝛽 𝐽𝛽+ 𝐽𝜀𝛽(𝜀)
(3.43) Khi đó: 𝑘(𝜀) =
Hình 3.9: Sơ đồ cấu trúc thuật toán xác định tham số động học của kênh phương vị
Sử dụng (3.40) và (3.43) ta có thể xây dựng được sơ đồ cấu trúc như hình 3.9 cho kênh phương vị theo sơ đồ hình 3.3 như trên.Cấu trúc khối nhận dạng nhiễu trên hình 3.9 và việc xác định hệ số 𝑘(𝜀) theo (3.43) sẽ cho ta khả năng áp dụng Định lý 3.1 với thuật toán xác định nhiễu (3.23).
Kết luận chương 3: Chương 3 đã xây dựng mô hình toán cho lớp đối tượng cơ điện điển hình và đề xuất phương pháp tổng hợp hệ thống điều khiển mode trượt cho một lớp đối tượng phi tuyến bất định dưới tác động của nhiễu bên ngoài. Đã đề xuất được thuật toán đánh giá nhiễu, cho phép nhận dạng – đánh giá nhiễu, kể cả nhiễu có tính đột biến. Ngoài ra, chương 3 đã xây dựng được luật điều khiển đảm bảo bù trừ tác động của nhiễu, đảm bảo chế độ trượt cho hệ thống và giảm thiểu được độ rung. Nhờ vậy, hệ thống có tính bền vững và có tính kháng nhiễu tốt.
18
Chương 4: TỔNG HỢP HỆ THỐNG ĐIỀU KHIỂN CHO PHÁO PHÒNG KHÔNG ZU23MM-2N CẢI TIẾN TRÊN CƠ SỞ CÁC PHƯƠNG PHÁP VÀ THUẬT TOÁN ĐÃ ĐỀ XUẤT.
Chương 4 thực hiện đánh giá và kiểm chứng thuật toán đề xuất trong thực tế bằng công cụ mô phỏng Matlab-simulink với đối tượng thực tế là hệ PPK tự động ZU23mm-2N tác chiến ngày và đêm do Viện Tự động hóa KTQS nghiên cứu thiết kế và chế tạo. 4.1. Xác định tham số trong mô hình động học của hệ thống 4.1.1 Cơ cấu chấp hành Hệ truyền động PPK ZU23mm-2N được sử dụng động cơ và biến tần của hãng Delta. Đây là hệ truyền động servo sử dụng động cơ đồng bộ xoay chiều nam châm vĩnh cửu (PMSM) với công suất 750W và đặc tính của bộ điều khiển 𝜏𝑚 = 𝐾𝑢. 4.1.2 Xác định tham số mô hình động lực học cho Zu23mm-2N cải tiến 4.1.2.1 Tham số mô hình động lực học kênh truyền động tà Phương trình động học của hệ truyền động tà được mô tả bằng phương
trình: 𝒥𝑡à(𝑡)𝜀̈ + 𝑘𝑡à𝜀̇ + 𝑔𝑡à(𝜀, 𝑡) + 𝑓𝑡à(𝑡) = 𝑢𝑡à
(4.1) Đặt: 𝑥1 = 𝜀 là góc tà; 𝑥2 = 𝑥̇1 là tốc độ góc tà. Từ phương trình (4.1) và thực nghiệm, động lực học hệ truyền động tà được mô tả bằng hệ phương trình vi phân: (4.4)
𝑥̇1 = 𝑥2 { 𝑥̇2 = −0.0988𝑥2 + 0.0395𝑢𝑡à − 13.5447cos (𝑥1) − 0.0395𝑓𝑡à 4.1.2.2. Tham số mô hình động lực học kênh truyền động phương vị Hệ truyền động phương vị có mô hình động học dưới dạng sau: (4.5) 𝒥𝑝𝑣(𝑡)𝛽̈ + 𝑘𝑝𝑣𝛽̇ + 𝑔𝑝𝑣(𝛽, 𝑡) + 𝑓𝑝𝑣(𝑡) = 𝑢𝑝𝑣
Đặt: 𝑥3 = 𝑥 = 𝛽 là giá trị góc phương vị; 𝑥4 = 𝑥̇3 là vận tốc góc phương
vị, từ thực nghiệm, hệ truyền động phương vị có thể viết dưới dạng: (4.14)
𝑥̇3 = 𝑥4 { 𝑥̇4 = −0.0236𝑥4 + 0.0094𝑢 − 𝑓(𝑥3, 𝑥4) − 𝑑 Với: 𝑓(𝑥3, 𝑥4) = 343. 𝑐𝑜𝑠(𝜀)(𝑠𝑖𝑛𝛽𝑠𝑖𝑛𝜃2 − 𝑐𝑜𝑠𝛽sin𝜃1𝑐𝑜𝑠𝜃3)
Với việc xác định được giá trị bất định lớn của nhiễu, sử dụng chế
4.2. Tổng hợp bộ điều khiển trên cơ sở giá trị lớn nhất của nhiễu độ trượt có thể khắc phục được ảnh hưởng của nhiễu. Tuy nhiên kết quả mô
19
phỏng cho thấy khi đánh giá nhiễu kém chính xác thì thành phần bù nhiễu phải có dự phòng cao, đồng thời sẽ gây ra hiện tượng rung xung quanh mặt trượt. Chính vì vậy cần xây dựng thuật toán nhận dạng nhiễu. 4.3 Tổng hợp bộ điều khiển trên cơ sở nhận dạng nhiễu 4.3.1. Nhận dạng nhiễu bất định
(4.16) Dưới đây, để có được đánh giá đối với hàm 𝑓(∙), luận án sử dụng mô hình song song mà động học của nó được mô tả bằng hệ phương trình (4.22). 𝑥̇1𝑚 = 𝑥2𝑚 { 𝑥̇2𝑚 = 𝑎2𝑥2𝑚 + 𝑏2𝑢
Thuật toán nhận dạng nhiễu được xây dựng theo (3.23). Áp dụng đối với các tham số của mô hình, nhận được thuật toán đánh giá nhiễu đối với kênh tà và kênh phương vị lần lượt là:
𝑓̂(∙) = 𝑒̇2 − 0.0988𝑒2 𝑓̂(∙) = 𝑒̇2 − 0.0236𝑒2 4.3.2 Xây dựng luật điều khiển
Luật điều khiển được xây dựng dựa trên kết quả của định lý 3.1 có dạng: 𝑢 = 𝑢𝑒𝑞 + 𝑢𝑑 + 𝑢𝑠 + 𝑢𝑏 Đối với kênh tà , chọn 𝐾𝑠 = 40, 𝑐1 = 55 bộ điều khiển kênh tà tổng hợp được có dạng:
𝑢𝑡à = 𝑢𝑒𝑞 + 𝑢𝑑 + 𝑢𝑠 + 𝑢𝑏
1 0.0395
= [(55 + 0.0988)𝑥2] + 40𝑆 + 𝛿𝑠𝑖𝑔𝑛𝑆 + (𝑒̇2 − 0.0988𝑒2)
Đối với kênh phương vị, chọn 𝑐 = 25 , 𝐾𝑠 = 85 , bộ điều khiển kênh phương vị có dạng:
𝑢𝑝𝑣 = 𝑢𝑒𝑞 + 𝑢𝑑 + 𝑢𝑠 + 𝑢𝑏
1 0.0094
= [(25 + 0.0236)𝑥4] + 85𝑆 + 𝛿𝑠𝑖𝑔𝑛𝑆 + (𝑒̇2 − 0.0236𝑒2)
4.3.3 Mô phỏng thuật toán 4.3.3.1 Mô phỏng với tín hiệu bước nhảy đơn vị
Hệ thống được mô phỏng với bước nhảy đơn vị 1(t) để kiểm chứng về thời gian quá độ và với xung nhiễu của phát bắn liên thanh 6 viên đạn với tốc độ 200 phát/phút ở thời điểm 5s và 8s trong trường hợp không nhận dạng nhiễu và có nhận dạng nhiễu.
20
Hình 4.10: Sai lệch góc khi không nhận dạng nhiễu
Hình 4.11: Mô men điều khiển khi không nhận dạng nhiễu
Hình 4.12: Sai lệch góc khi bổ sung nhận dạng nhiễu
Hình 4.13: Mô men điều khiển khi bổ sung nhận dạng nhiễu
Như vậy, chỉ tiêu về sai số góc bám được đảm bảo trong dải ±2 mrad. Tuy nhiên khi được bổ sung khối nhận dạng nhiễu, sai lệch góc đã được giảm đi rõ rệt, đặc biệt là sai lệch góc do nhiễu đột biến từ phát bắn gây ra. Mô men điều khiển vẫn đảm bảo không có hiện tượng rung.
21
4.3.3.2 Mô phỏng với tín hiệu hình sin Tín hiệu hình sin đại diện cho mục tiêu di động. Tốc độ của mục tiêu được thể hiện qua tần số thay đổi của tín hiệu.
Hình 4.14: Sai lệch góc bám tín hiệu hình sin
Hình 4.15: Mô men điều khiển bám tín hiệu hình sin
Nhận xét: Kết quả mô phỏng bám tín hiệu hình sin trên hình 4.14 và hình 4.15 cho thấy bộ điều khiển hoàn toàn chế áp được nhiễu có tính đột biến do ảnh hưởng của phát bắn, đảm bảo sai lệch góc bám dưới ±1 mrad, trong khi đó mô men điều khiển không có hiện tượng rung. Như vậy thuật toán điều khiển đề xuất có hiệu quả rất tốt. 4.4 Mô phỏng các thuật toán với bài bắn mục tiêu bay vào trận địa 4.4.1 Tham số mục tiêu mô phỏng Các tham số chuyển động của mục tiêu được xác định từ các công thức
ℎ = 𝒟1 sin ℰ1 = 300𝑚; 𝜗 = 200 𝑚/𝑠; 𝛽1 = 86,10; 𝜌 = 𝑑1 cos 𝛽1 = 𝒟1. cos 𝜀1 cos 𝛽1 = 100𝑚. (2.7), (2.8), (2.9), (2.12) và (2.13), bao gồm: 4.4.2 Mô phỏng với thuật toán PIV
PIV là một thuật toán tổng hợp bộ điều khiển trên nền bộ điều khiển PID kinh điển, trong đó bổ sung một khâu truyền thẳng với đầu vào là tốc độ của tín hiệu bám thông qua một hệ số tốc độ Kv.
22
Hình 4.18: Sai lệch góc theo thuật toán PIV
Hình 4.19: Mô men điều khiển theo thuật toán PIV
Nhận xét: Kết quả mô phỏng trên hình 4.18 cho thấy khi không chịu tác động của phát bắn, sai lệch bám góc của hệ thống được đảm bảo trong dải ± 2mrad. Tuy nhiên, ở thời điểm tiêu diệt mục tiêu, nhiễu đột biến làm cho đường ngắm của pháo có thể bị văng ra khỏi tâm mục tiêu từ 6-8mrad. 4.4.3 Mô phỏng với thuật toán đề xuất
Hình 4.20: Sai lệch góc theo thuật toán đề xuất
Hình 4.21: Mô men điều khiển theo thuật toán đề xuất
23
Nhận xét: Hình 4.9 cho thấy thuật toán đề xuất đảm bảo sai số góc của hệ thống không vượt quá ±1,5mrad ngay cả chịu tác động của lực bắn. Hơn nữa mô men điều khiển không bị rung (hình 4.21). 4.5. Kết quả bắn đạn thật thử nghiệm hệ thống với bộ điều khiển PIV Các thử nghiệm bắn mục tiêu cố định ở cự ly 400m, cự ly 1000m và bắn mục tiêu di động ở cự ly 800m. Kết quả bắn đạn thật cho thấy, bộ điều khiển PIV với thuật toán bù nghiêng đảm bảo cho hệ thống bắn mục tiêu cố định. Trong dải sai số ±3mrad, xác suất bắn trúng bia cố định là 50%. Khi bộ điều khiển đề xuất được thực thi thay thế cho bộ điều khiển PIV hiện có trong hệ thống điều khiển hỏa lực ZU23-2N, sự rung giật khi bắn được giảm đi do nòng pháo được đưa về vị trí chính xác trước mỗi phát bắn.
Hình 4.22: Kết quả bắn mục tiêu cố định ở cự ly 400m và bắn mục tiêu di động ở cự ly 800m
Kết luận chương 4: Trên cơ sở giải pháp cải tiến hệ truyền động của pháo ZU23mm-2N trong thực tiễn và qua khảo nghiệm thực tế, chương 4 đã xây dựng mô hình động học cho các hệ truyền động phương vị và tà của pháo sau cải tiến. Luận án đã áp dụng các phương pháp tổng hợp bộ điều khiển trong chương 2 và chương 3 để tổng hợp bộ điều khiển bám cho hai kênh truyền động tà và phương vị. Các kết quả mô phỏng và thực tế bắn đạn thật đã cho thấy: Hệ thống sử dụng thuật toán bù nghiêng ở chương 2 đã cho kết quả bắn đạt yêu cầu với bộ điều khiển PIV. Với kết quả mô phỏng tương ứng, các hệ truyền động sử dụng bộ điều khiển tổng hợp được có tính ổn định bền vững cao dưới tác động của nhiễu và sự bất định của các thành phần mô men quán tính gây ra. Đây chính là cơ sở để khẳng định khả năng áp dụng các thuật toán được đề xuất, làm cho chất lượng hệ thống được nâng cao.
24
KẾT LUẬN Qua quá trình nghiên cứu, luận án đã đưa ra được một phương pháp
tổng hợp bộ điều khiển phi tuyến cho một lớp đối tượng cơ điện I. Những đóng góp mới của luận án
Luận án xác lập có 4 điểm đóng góp mới như sau: - Thứ nhất, luận án đã xây dựng được mô hình toán học mô tả đầy đủ động học của đối tượng điều khiển trong hệ thống điều khiển hỏa lực sử dụng bộ truyền động cơ điện, trong đó đã chỉ rõ sự tồn tại của các yếu tố phi tuyến bất định và các dạng nhiễu tác động lên hệ thống.
- Thứ hai, luận án đã đề xuất thuật toán xác định tham số đầu vào hệ điều khiển truyền động bám trong hệ điều khiển hỏa lực, thuật toán xử lý số liệu góc nghiêng, đảm bảo khả năng bù góc nghiêng của nòng pháo bắn trong điều kiện phi tiêu chuẩn (đế pháo không nằm trên mặt phẳng chuẩn).
- Thứ ba, luận án xây dựng phương pháp nhận dạng thành phần phi tuyến bất định và nhiễu trên cơ sở sử dụng mô hình mẫu; chứng minh được định lý về điều kiện đủ, đảm bảo quá trình nhận dạng hội tụ đối với một lớp đối tượng phi tuyến bất định có tác động của nhiễu bên ngoài đặc biệt là với các nhiễu đột biến, không trơn.
- Thứ tư, luận án đã tổng hợp được luật điều khiển ứng dụng các thuật toán xử lý số liệu đầu vào, thuật toán xử lý số liệu phản hồi và kết quả nhận dạng nhiễu bằng mô hình song song cho một lớp đối tượng cơ điện điển hình, mô phỏng cụ thể với hệ thống tự động điều khiển hỏa lực của PPK ZU23mm- 2N cải tiến. II. Hướng nghiên cứu và phát triển tiếp theo
Luận án kiến nghị hướng nghiên cứu phát triển tiếp theo như sau: - Một là, thực thi thuật toán tổng hợp dựa trên kết quả nhận dạng nhiễu đột biến bằng ngôn ngữ lập trình kỹ thuật để có thể dễ dàng tích hợp, cài đặt, thử nghiệm thuật toán trong hệ thống điều khiển hỏa lực hiện có.
- Hai là, mở rộng thuật toán tổng hợp số liệu đầu vào để đánh giá khả năng ổn định đường ngắm và bám sát mục tiêu đối với các quỹ đạo mục tiêu khác trong thực t
DANH MỤC CÁC CÔNG TRÌNH KHOA HỌC ĐÃ CÔNG BỐ
1. Trần Ngọc Bình, Nguyễn Vũ, “Thuật toán xử lý số liệu phục vụ tích hợp hệ thống điều khiển hỏa lực cho cPPK 37mm-2N bắn trong hành quân”. Tạp chí Nghiên cứu khoa học và công nghệ Quân sự, Số 31, Tháng 6-2014, tr. 100-103.
2. Cao Tiến Huỳnh, Nguyễn Vũ, Trần Ngọc Bình, Nguyễn Trung Kiên, “Tổng hợp hệ điều khiển theo chế độ trượt cho một lớp đối tượng bất định, dưới tác động của nhiễu ”, Tạp chí Nghiên cứu khoa học và công nghệ Quân sự, Số 37, Tháng 6-2015, tr. 53-60.
3. Lê Việt Hồng, Nguyễn Vũ, Trần Ngọc Bình,“Về một phương pháp nâng cao chất lượng điều khiển cho hệ thống truyền động cơ điện”, Tạp chí Nghiên cứu khoa học và công nghệ Quân sự, Số 38, Tháng 8-2015, tr. 44-50.
4. Vũ Quốc Huy, Trần Ngọc Bình, Đỗ Quảng Đại, “Thuật toán tính góc trục và góc bệ thiết lập cho đài quan sát phòng không cơ động”, Tạp chí Nghiên cứu khoa học và công nghệ Quân sự, Đặc san 55 năm Viện KHCNQS, Tháng 10-2015, tr. 217-224.
5. Trần Ngọc Bình, Nguyễn Vũ, “Phương phác xác định tham số đầu vào cho hệ điều khiển bám của các khẩu đội pháo phòng không cơ động trong chế độ dừng bắn”, Tạp chí Nghiên cứu khoa học và công nghệ Quân sự, Số 41, Tháng 2-2016, tr. 61-68.
