- Thí nghiệm 4: Mô phỏng điều khiển tổng hợp hướng đi, độ sâu và tốc độ AUV
Hình 4 11 Sơ đồ mô phỏng điều khiển tốc độ AUV
Trong thí nghiệm mô phỏng này hướng đi thay đổi từ 0 sang 10, đến giây thứ 200 lại thay đổi về 0, sang giây thứ 400 lại thay đổi sang 15; độ sâu thay đổi từ 10m sang 2m, tốc độ tăng từ 0 3m/s lên 0 4m/s BĐK thực hiện điều khiển tốt hướng đi, độ sâu và tốc độ AUV đến điểm đặt mong muốn
Trường hợp này AUV hoạt động trong điều khiện không có tác động của dòng chảy
Hình 4 12 Đáp ứng hướng đi của AUV trong TN4
Hình 4 14 Đáp ứng tốc độ của AUV trong TN4
Hình 4 15 Vết chuyển động của AUV
4 2 4 Điều khiển tổng hợp các chuyển động khi có dòng chảy
- Thí nghiệm 5: Mô phỏng điều khiển tổng hợp hướng đi, độ sâu và tốc độ AUV khi có dòng chảy tác động
Hình 4 16 Đáp ứng hướng đi của AUV khi có dòng chảy (TN5)
Hình 4 18 Đáp ứng độ sâu của AUV trong TN5
Trong thí nghiệm mô phỏng này, tương tự phần trên, hướng đi thay đổi từ 0 sang 10, đến giây thứ 200 lại thay đổi về 0, sang giây thứ 400 lại thay đổi sang 15; độ sâu thay đổi từ 10m sang 2m, tốc độ tăng từ 0 3m/s lên 0 4m/s Dòng chảy làm hướng AUV dao động tuy nhiên hướng đi, độ sâu và tốc độ vẫn đạt đến các giá trị đặt
Nhận xét các kết quả:
Các kết quả điều khiển AUV trong chương này chưa ràng buộc AUV chuyển động theo một quỹ đạo nhất định Hướng đi, độ sâu và tốc độ được điều khiển theo giá trị đặt BĐK NNC được khởi tạo các giá trị ngẫu nhiên ban đầu cho các trọng số của mạng nơ-ron Qua quá trình điều khiển, mạng nơ-ron được cập nhật các trọng số theo tiêu chí cực tiểu hóa hàm mục tiêu của từng tình huống điều khiển Việc cập nhật này diễn ra trong từng chu trình điều khiển, được đảm bảo bởi cách thiết lập hàm mục tiêu và thuật toán tính trọng số của các lớp ẩn, lớp ra của mạng nơ-ron để tính ra được lệnh điều khiển
Trong các phần đầu Chương 4 tác giả đã mô phỏng điều khiển bằng BĐK NNC cho các tình huống riêng biệt về hướng đi, độ sâu và tốc độ của AUV Các BĐK làm việc hiệu quả và đạt được mục tiêu điều khiển theo giá trị đặt Trong trường hợp hoạt động đồng thời các chuyển động của AUV, BĐK NNC thể hiện tốt khả năng điều khiển khi không có và có dòng chảy tác động lên AUV
Khi kết hợp với hệ thống dẫn đường, các BĐK sẽ giúp AUV chuyển động theo quỹ đạo, theo độ sâu hay theo tốc độ mong muốn hoặc đồng thời tuân theo các yêu cầu tổng hợp đó tùy vào tình huống công tác Các phần tiếp theo sau đây của Chương 4 sẽ mô phỏng hoạt động của AUV trong một số hoạt động như vậy
Điều khiển hoạt động của AUV ngầm dưới nước phục vụ các công việc đặt ra một nhiệm vụ khó khăn, phức tạp Không những hệ động lực của AUV phải mạnh, hiệu quả, các cảm biến tốc độ, độ sâu, khoảng cách, vị trí phải
chính xác mà thuật toán điều khiển cũng phải bền vững, hệ thống dẫn đường phải chính xác, tin cậy đạt hiệu quả cao
Trong Chương 3 tác giả đề xuất kết hợp hệ thống dẫn đường LOS với BĐK hướng đi AUV để dẫn đường theo quỹ đạo, đồng thời điều khiển độ sâu và tốc độ AUV theo giá trị mong muốn Đề tài chỉ giới hạn nghiên cứu đề xuất hệ thống dẫn đường AUV đi theo các điểm chuyển hướng mà quãng đường giữa các điểm là thẳng Các yêu cầu điều khiển và hiệu chỉnh nâng cao chất lượng điều khiển như đưa khoảng cách dạt khỏi đường đi trong mặt phẳng ngang vào hàm mục tiêu BĐK hướng (phương trình 3 68), thành phần tích phân sai số tốc độ Zk vào hàm mục tiêu BĐK tốc độ (phương trình 3 47) đã giúp nâng cao chất lượng điều khiển, đạt được khả năng thích nghi với tác động ngoại cảnh lên AUV và tính phi tuyến của động học AUV khi diễn ra đồng thời các chuyển động trong 6 bậc tự do Phần tiếp theo tác giả sẽ trình bày kết quả các thí nghiệm mô phỏng minh họa cho hệ thống điều khiển dẫn đường đã đề xuất trong Chương 3
4 3 Mô phỏng điều khiển dẫn đường AUV và thực hiện các nhiệm vụdưới nước dưới nước
Tình huống trong phần 4 3 của chương này gồm các mô-đun sau:
submarine m: npsauv m: CurrGen m: annaiTrain m: mlnnc m: LOSguide m: offtrackdist m:
là file chương trình mô phỏng chính là file mô hình toán học AUV
là file tạo ra tác động của dòng chảy lên AUV là file chương trình huấn luyện mạng nơ-ron điều khiển theo thuật toán thích nghi tương tác
là file mạng nơ-ron tạo ra các tham số điều khiển là file tính hướng đi LOS cho AUV
là file tính khoảng cách lệch khỏi đường đi trên mặt phẳng ngang của AUV
Hình 4 20 Mô phỏng hệ thống điều khiển và dẫn đường AUV
Trong phần này tác giả mô phỏng những tình huống sau đây:
- Thí nghiệm 6: Điều khiển AUV chuyển động theo quỹ đạo hình vuông, độ sâu không đổi, không có dòng chảy tác động
- Thí nghiệm 7: Điều khiển AUV chuyển động theo quỹ đạo hình vuông, độ sâu thay đổi, không có dòng chảy tác động
- Thí nghiệm 8: Điều khiển AUV theo quỹ đạo zig-zag khi không có dòng chảy tác động, độ sâu không đổi
- Thí nghiệm 9: Điều khiển AUV theo quỹ đạo zig-zag khi có dòng chảy tác động, độ sâu không đổi
- Thí nghiệm 10: Mô phỏng điều động zig-zag khi tính đến độ lệch khỏi đường đi theo mặt phẳng ngang
- Thí nghiệm 11: Mô phỏng điều động zig-zag khi tính đến độ lệch khỏi đường đi theo mặt phẳng ngang, có dòng chảy tác động
4 3 1 Điều khiển AUV theo quỹ đạo đặt trước
- Thí nghiệm 6: Điều khiển AUV chuyển động theo quỹ đạo hình vuông, độ sâu không đổi, không có dòng chảy tác động
Đồ thị phía trên của hình 4 21 là hướng đi thực tế của AUV (nét liền, xanh) và hướng đi mong muốn (nét đứt, đỏ) Hướng đi mong muốn được thuật toán dẫn đường tính toán tự động BĐK NNC làm cho hướng đi thực tế bám
theo giá trị hướng đi mong muốn này và do đó, AUV chuyển động theo quỹ đạo hình vuông mong muốn
Hình 4 21 Đáp ứng hướng đi của AUV trong TN6
Hình 4 23 Đáp ứng tốc độ trong TN6
Hình 4 24 Vết chuyển động của AUV trong TN6
Hình 4 21 và 4 22 cho thấy tác động qua lại phức tạp của hướng đi và độ sâu khi AUV chuyển hướng Độ sâu AUV dao động mỗi khi nó chuyển sang hướng đi mới tại góc vuông của quỹ đạo
Hình 4 25 Quỹ đạo trên mặt phẳng ngang của AUV trong TN6
- Thí nghiệm 7: Điều khiển AUV chuyển động theo quỹ đạo hình vuông, độ sâu thay đổi, không có dòng chảy tác động
Hình 4 27 Đáp ứng độ sâu của AUV trong TN7
Hình 4 29 Quỹ đạo chuyển động của AUV trong TN7
Hình 4 30 Quỹ đạo trên mặt phẳng ngang của AUV trong TN7
Trong thí nghiệm mô phỏng này, độ sâu của điểm chuyển hướng thứ 3 giảm từ 10m về 3m Cánh điều khiển phía trước được điều khiển bởi một BĐK PD với hệ số khuếch đại tỉ lệ nhỏ để hỗ trợ Trên từng đoạn của quỹ đạo, AUV bám theo đường đi ở mặt phẳng ngang và ở phương độ sâu, giá trị độ sâu đạt được như mong muốn
- Thí nghiệm 8: Điều khiển AUV theo quỹ đạo zig-zag khi không có dòng chảy tác động, độ sâu không đổi
Hình 4 31 Đáp ứng hướng đi của AUV trong TN8
Hình 4 33 Đáp ứng tốc độ của AUV trong TN8
Hình 4 34 Quỹ đạo chuyển động của AUV trong TN8
Đây là hoạt động khá phức tạp của AUV khi quỹ đạo chuyển động là đường zig-zag tạo bởi các đoạn vuông góc trong hoạt động khảo sát đáy biển hoặc tìm kiếm cứu nạn, thăm dò,… (hình 4 34)
Hình 4 35 Quỹ đạo của AUV trên mặt phẳng ngang trong TN8
Hướng đi mong muốn trên từng đoạn có thể là LOS, hướng dọc theo đoạn quỹ đạo hiện thời (từ điểm đầu đến điểm cuối đoạn đường hiện thời), hoặc hướng từ vị trí hiện tại của AUV tới điểm chuyển hướng hiện tại phía trước Trong trường hợp này hướng LOS được chọn BĐK NNC được dùng cho cả bánh lái hướng và cánh điều khiển độ sâu phía trước và sau của NPS AUV II
- Thí nghiệm 9: Điều khiển AUV theo quỹ đạo zig-zag khi có dòng chảy tác động, độ sâu không đổi
Hình 4 37 Đáp ứng tốc độ của AUV trong TN9
Hình 4 39 Quỹ đạo chuyển động của AUV trong TN9
Hình 4 40 Quỹ đạo của AUV trên mặt phẳng ngang trong TN9
Trong Thí nghiệm 9 dòng chảy tác động làm hướng và vị trí AUV dịch chuyển và dao động Độ sâu cũng dao động nhưng vẫn đảm bảo trên mặt phẳng ngang
- Thí nghiệm 10: Mô phỏng điều động zig-zag khi tính đến độ lệch khỏi đường đi theo mặt phẳng ngang
Hình 4 41 Đáp ứng hướng đi của AUV trong TN10
Hình 4 43 Đáp ứng tốc độ của AUV trong TN10
Hình 4 45 Quỹ đạo trên mặt phẳng ngang của AUV trong TN10
Hình 4 46 Khoảng cách dạt trên mặt phẳng ngang (TN10)
Trong Thí nghiệm 10, BĐK NNC chỉ điều khiển cánh điều khiển độ sâu phía sau do AUV chỉ làm việc trong mặt phẳng ngang, BĐK PD điều khiển cánh phía trước giúp ổn định góc chúi AUV Hướng dẫn đường là hướng giữa 2 điểm chuyển hướng của đoạn quỹ đạo hiện tại Độ dạt ngang được đưa vào thuật toán học online của BĐK NNC giúp AUV ổn định bám theo quỹ đạo
- Thí nghiệm 11: Mô phỏng điều động zig-zag khi tính đến độ lệch khỏi đường đi theo mặt phẳng ngang, có dòng chảy tác động
Hình 4 47 Đáp ứng hướng đi của AUV trong TN11
Hình 4 49 Đáp ứng tốc độ của AUV trong TN11
Hình 4 50 Quỹ đạo chuyển động của AUV trong TN11
Ảnh hưởng tác động của ngoại cảnh làm AUV dao động và dạt ngang nhưng vẫn ổn định xung quanh quỹ đạo chuyển động mong muốn
Hình 4 51 Quỹ đạo trên mặt phẳng ngang của AUV trong TN11
Hình 4 52 Khoảng cách dạt trên mặt phẳng ngang (TN11)
Mục đích của thí nghiệm này là minh họa hoạt động của hệ thống điều khiển dẫn đường trên hình 3 11 Trong đó BĐK NNC nhận dạng tác động của dòng chảy thông qua độ dạt do nó gây ra cho AUV được tính trong mỗi chu trình điều khiển Độ dạt này đại diện bởi tham số (mục 3 5 2) Quá trình học của mạng nơ-ron được tính đến giá trị (phương trình 3 68) nên BĐK
thích nghi với tác động của dòng chảy qua mỗi chu trình điều khiển, làm cho AUV bám sát quỹ đạo mong muốn mặc dù dòng chảy có xu hướng đẩy dạt AUV ra xa quỹ đạo này, hoặc sau mỗi lần thay đổi hướng trên đoạn đường tiếp theo, khoảng cách từ AUV đến đoạn quỹ đạo mới lại ổn định dần về zero (hình 4 52, đồ thị phía trên)
4 3 2 Điều khiển AUV bám theo địa hình đáy
- Thí nghiệm 12: Mô phỏng điều khiển AUV bám theo địa hình đáy
Hình 4 54 Đáp ứng độ sâu của AUV trong TN12
Hình 4 56 Độ sâu thực tế của AUV (nét liền, xanh) và đáy (nét đứt, đỏ)
Trong thí nghiệm này, AUV đi thẳng theo hướng cố định 0 có tác động của dòng chảy Vị trí của AUV theo chiều thẳng đứng (trục Oz) luôn cách đáy khoảng cách 5m Trong thực tế khoảng cách này luôn xác định được bằng máy đo sâu hồi âm Kết quả mô phỏng cho thấy AUV luôn đi theo quỹ đạo ổn định cách đáy một khoảng cách mong muốn 5m với sai số nhỏ và bám theo hình dạng đáy
4 4 Mô phỏng điều khiển AUV thích nghi với ngoại cảnh
4 4 1 Điều khiển AUV dưới tác động của dòng chảy
- Thí nghiệm 13: Mô phỏng điều khiển AUV bám theo đường thẳng khi chưa tính đến độ dạt khỏi đường đi trong thuật toán điều khiển
Hình 4 58 Đáp ứng tốc độ của AUV trong TN13
Hình 4 60 Quỹ đạo chuyển động của AUV trong TN13
Hình 4 61 Quỹ đạo trên mặt phẳng ngang của AUV trong TN13
Trong tình huống này tồn tại độ dạt ngang khoảng 5m so với đường đi mong muốn Tác giả dùng công thức tính độ dạt này và đưa vào hàm mục tiêu của BĐK NNC cho hướng đi AUV Kết quả được kiểm tra trong Thí nghiệm 14
4 4 2 Điều khiển AUV thích nghi với tác động của dòng chảy
- Thí nghiệm 14: Mô phỏng điều khiển AUV bám theo đường thẳng có tính đến độ dạt khỏi đường đi trong thuật toán điều khiển NNC
Hình 4 63 Đáp ứng hướng đi của AUV trong TN14
Hình 4 65 Đáp ứng độ sâu của AUV trong TN14
Hình 4 66 Qũy đạo chuyển động của AUV trong TN14
Hình 4 68 Khoảng cách dạt của AUV và vận tốc dòng chảy trong TN14
Trên đồ thị phía trên của hình 4 64, đáp ứng tốc độ của AUV sau khi ổn định tồn tại sai số tĩnh Để khắc phục nhược điểm này, thành phần tích phân Zk của sai số tốc độ được đưa vào hàm mục tiêu để huấn luyện mạng nơ- ron điều khiển Kết quả mô phỏng để kiểm tra chất lượng điều khiển được thực hiện qua Thí nghiệm 15
- Thí nghiệm 15: Mô phỏng điều khiển AUV bám theo đường thẳng có tính đến độ dạt khỏi đường đi trong thuật toán điều khiển NNC, thêm thành phần tích phân cho BĐK tốc độ
Hình 4 70 Đáp ứng tốc độ của AUV trong TN15
Hình 4 72 Quỹ đạo chuyển động của AUV trong TN15
Hình 4 73 Quỹ đạo trên mặt phẳng ngang của AUV trong TN15
Trên hình 4 70 đã không còn sai số tĩnh của tốc độ khi ổn định Độ dạt ngang của AUV khỏi quỹ đạo cũng đã được loại bỏ giúp AUV bám theo quỹ đạo thẳng trên mặt phẳng ngang Trên đồ thị 1 hình 4 71 độ vượt quá điều khiển lớn của giá trị độ sâu ở giai đoạn đầu có thể hiểu là AUV vừa thay đổi độ sâu vừa tăng tốc độ, góc chúi ngẩng lên đến 20 (đồ thị giữa của hình 4 71) đã gây nên kết quả này
4 5 Kết luận chương 4
Ở chương 4 tác giả đã mô phỏng điều khiển bằng BĐK NNC cho các tình huống riêng biệt về hướng đi, độ sâu và tốc độ của AUV Các BĐK làm việc hiệu quả và đạt được mục tiêu điều khiển theo giá trị đặt Trong trường hợp hoạt động đồng thời các chuyển động của AUV, BĐK NNC thể hiện tốt khả năng điều khiển khi không có và có dòng chảy tác động lên AUV
Cũng trong chương này tác giả đã trình bày các tình huống mô phỏng