Trên tàu thủy tín hiệu quỹ đạo, vị trí tàu được xác định thông qua thiết bị GPS, hướng tàu được xác định bằng thiết bị la bàn điện. Để mô hình thực nghiệm càng gần với thực tế mô hình [r]
(1)BỘ GIÁO DỤC VÀ ĐÀO TẠO BỘ GIAO THÔNG VẬN TẢI
TRƯỜNG ĐẠI HỌC HÀNG HẢI VIỆT NAM
NGUYỄN HỮU QUYỀN
NGHIÊN CỨU GIẢI PHÁP ĐIỀU KHIỂN BÁM QUỸ ĐẠO TÀU THỦY CĨ RÀNG BUỘC TÍN HIỆU VÀ BẤT
ĐỊNH HÀM Ở ĐẦU VÀO
(2)
BỘ GIÁO DỤC VÀ ĐÀO TẠO BỘ GIAO THÔNG VẬN TẢI
TRƯỜNG ĐẠI HỌC HÀNG HẢI VIỆT NAM
NGUYỄN HỮU QUYỀN
NGHIÊN CỨU GIẢI PHÁP ĐIỀU KHIỂN BÁM QUỸ ĐẠO TÀU THỦY CĨ RÀNG BUỘC TÍN HIỆU VÀ BẤT
ĐỊNH HÀM Ở ĐẦU VÀO
LUẬN ÁN TIẾN SĨ KỸ THUẬT
NGÀNH: KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HÓA MÃ SỐ: 9520216
CHUYÊN NGÀNH: KỸ THUẬT ĐIỀU KHIỂN VÀ TỰ ĐỘNG HÓA
(3)LỜI CAM ĐOAN
Tôi xin cam đoan công trình nghiên cứu cá nhân tơi hướng dẫn giáo viên hướng dẫn nhà khoa học Các tài liệu tham khảo trích dẫn đầy đủ Kết nghiên cứu trung thực chưa công bố cơng trình khác
Hải Phịng, ngày tháng 12 năm 2019
Giáo viên hướng dẫn Tác giả
PGS.TS Trần Anh Dũng Nguyễn Hữu Quyền
(4)LỜI CẢM ƠN
Trong q trình làm luận án, tơi nhận nhiều góp ý chun mơn ủng hộ giúp đỡ giáo viên hướng dẫn, nhà khoa học, đồng nghiệp Tôi xin gửi tới họ lời cảm ơn sâu sắc
Tơi xin bày tỏ lịng cảm ơn đến giáo viên hướng dẫn trực tiếp hướng dẫn suốt thời gian qua
Tôi xin chân thành cảm ơn nhà khoa học, Khoa Điện - Điện tử, Viện đào tạo sau đại học, trường Đại học Hàng hải Việt Nam tạo điều kiện thuận lợi cho tơi suốt q trình học tập nghiên cứu thực luận án
Cuối lời cảm ơn ủng hộ, động viên khích lệ to lớn gia đình để tơi hồn thành nhiệm vụ học tập
Hải Phòng, Ngày tháng 12 năm 2019
Tác giả luận án
(5)MỤC LỤC
MỞ ĐẦU
1 Tính cấp thiết đề tài
2 Mục đích nhiệm vụ đề tài Đối tượng phạm vi nghiên cứu luận án
4 Phương pháp nghiên cứu
5 Ý nghĩa lý luận thực tiễn
6 Bố cục luận án
CHƢƠNG MƠ HÌNH TỐN VÀ TỔNG QUAN BÀI TOÁN ĐIỀU KHIỂN CHUYỂN ĐỘNG TÀU THỦY 1.1 Mơ hình tốn mơ tả chuyển động tàu thủy
1.1.1 Mô tả chuyển động tàu thủy hệ quy chiếu
1.1.2 Các hệ quy chiếu
1.1.3 Mơ hình tốn mơ tả chuyển động tàu thuỷ bậc tự 1.1.3.1 Mối quan hệ vị trí, hướng vận tốc chuyển
động tàu thủy
1.1.3.2 Phương trình mô tả động lực học tàu thủy 10 1.1.3.3 Mô hình tốn tàu thuỷ bậc tự 12 1.1.4 Mơ hình tốn mơ tả chuyển động tàu thủy ba bậc tự (xét mặt
phẳng ngang) 13
1.1.5 Mơ hình tốn mơ tả chuyển động tàu thủy ba bậc tự thiếu cấu chấp hành mặt phẳng ngang 17 1.1.5.1 Mơ hình tốn mơ tả chuyển động tàu thủy ba bậc tự
thiếu cấu chấp hành mặt phẳng ngang dạng mơ
hình xác định 20
1.1.5.2 Mơ hình tốn bất định mơ tả chuyển động tàu thủy ba bậc tự thiếu cấu chấp hành mặt phẳng ngang 21 1.2 Tổng quan nghiên cứu điều khiển chuyển động tàu thủy 23 1.2.1 Tình hình nghiên cứu nước 23 1.2.2 Tình hình nghiên cứu nước 24
1.2.2.1 Tổng quan điều khiển chuyển động tàu thủy đủ cấu
(6)1.2.2.2 Tổng quan điều khiển chuyển động tàu thủy thiếu cấu
chấp hành 25
1.3 Hướng nghiên cứu luận án 31 1.3.1 Vấn đề đặt luận án 31 1.3.2 Ý nghĩa vấn đề ràng buộc tín hiệu điều khiển 32
1.4 Kết luận chương 32
CHƢƠNG ĐIỀU KHIỂN CHUYỂN ĐỘNG TÀU THỦY BÁM QUỸ ĐẠO ĐẶT VỚI BỘ ĐIỀU KHIỂN DỰ BÁO CĨ RÀNG BUỘC TÍN HIỆU ĐIỀU KHIỂN KHI MƠ HÌNH TÀU XÁC ĐỊNH 33
2.1 Nguyên lý điều khiển dự báo 34
2.1.1 Cấu trúc điều khiển dự báo 34 2.1.1.1 Khối mơ hình dự báo 35
2.1.1.2 Khối hàm mục tiêu 36
2.1.1.3 Khối tối ưu hóa 36
2.1.1.4 Nguyên lý trượt dọc trục thời gian 37 2.1.2 Điều khiển dự báo hệ tuyến tính phản hồi trạng thái 38 2.1.3 Giải pháp điều khiển dự báo hệ song tuyến sở tuyến tính hóa
từng đoạn mơ hình phi tuyến dọc theo trục thời gian 39 2.1.4 Một số giải pháp nâng cao chất lượng điều khiển dự báo 43
2.1.4.1 Nâng cao tốc độ hội tụ sai lệch bám nhờ hiệu chỉnh tín hiệu đặt theo nguyên lý học lặp (Iterative Learning) 43 2.1.4.2 Lọc nhiễu chuyển phản hồi trạng thái thành phản hồi
đầu nhờ quan sát Kalman 44 2.2 Các phương pháp tối ưu hóa có ràng buộc 46 2.2.1 Những phương pháp tối ưu hóa có ràng buộc thường sử dụng 46 2.2.1.1 Phương pháp tối ưu hóa truyền thống 46 2.2.1.2 Phương pháp tối ưu tiến hóa 47 2.2.2 Giải pháp điều khiển tối ưu hóa có ràng buộc với điều khiển
MPC 47 2.3 Thiết kế điều khiển MPC điều khiển chuyển động tàu bám quỹ
(7)2.3.1 Thiết kế điều khiển dự báo phản hồi trạng thái điều khiển tàu chuyển động bám quỹ đạo đặt mơ hình tàu xác định 49 2.3.1.1 Mơ hình dự báo sở tuyến tính hóa đoạn mơ
hình dọc trục thời gian 50
2.3.1.2 Xây dựng khối hàm mục tiêu điều khiển MPC 51 2.3.1.3 Xây dựng khối tối ưu hóa điều khiển 52 2.3.1.4 Thuật toán điều khiển dự báo phản hồi trạng thái 53 2.3.1.5 Mô điều khiển MPC-S 55 2.3.2 Thiết kế điều khiển dự báo phản hồi đầu theo nguyên lý tách
để điều khiển chuyển động tàu bám quỹ đạo đặt mơ hình tàu xác định 62 2.3.2.1 Xây dựng quan sát trực tiếp trạng thái từ mơ hình liên
tục 63
2.3.2.2 Xây dựng quan sát trạng thái lọc nhiễu nhờ lọc
Kalman mở rộng (EKF) 68
2.3.2.3 Thuật toán điều khiển dự báo phản hồi đầu với
QSTT 72
2.3.2.4 Kết mô điều khiển dự báo phản hồi đầu
MPC-O 74
2.4 Chứng minh tính ổn định hệ điều khiển dự báo đề xuất 81
2.5 Kết luận chương 85
CHƢƠNG ĐIỀU KHIỂN CHUYỂN ĐỘNG TÀU THỦY BÁM QUỸ ĐẠO ĐẶT VỚI BỘ ĐIỀU KHIỂN DỰ BÁO KHI MƠ HÌNH TÀU CĨ CHỨA THÀNH PHẦN BẤT ĐỊNH 86 3.1 Cấu trúc mô hình bù thành phần bất định 86 3.2 Giải pháp bù thành phần bất định 89
3.2.1 Bù thành phần bất định 89
3.2.2 Mô ước lượng bù bất định 91 3.2.2.1 Mô kiểm chứng ước lượng với tín hiệu bất định
dạng hàm bất định tác động từ bên 92 3.2.2.2 Mơ kiểm chứng ước lượng với tín hiệu bất định
(8)3.2.2.3 Đánh giá ước lượng bù bất định 95 3.3 Thiết kế điều khiển dự báo điều khiển chuyển động tàu thủy bám
quỹ đạo đặt mơ hình có bất định hàm đầu vào 95 3.3.1 Thiết kế điều khiển dự báo bù bất định phản hồi trạng thái 95
3.3.1.1 Thuật toán điều khiển dự báo bù bất định phản hồi trạng
thái 95
3.3.1.2 Cài đặt điều khiển dự báo bù bất định phản hồi trạng
thái DMPC-S 98
3.3.1.3 Kết mô phỏng, đánh giá chất lượng điều khiển
DMPC-S 99
3.3.2 Thiết kế điều khiển dự báo bù bất định phản hồi đầu 104 3.3.2.1 Thuật toán điều khiển dự báo bù bất định phản hồi đầu 104 3.3.2.2 Mô điều khiển dự báo bù bất định phản hồi đầu
ra DMPC-O 107
3.3.2.3 Kết mô phỏng, đánh giá chất lượng điều khiển
DMPC-O 108
3.4 Kết luận chương 115
3.4.1 Những vấn đề thực 115
3.4.2 Các vấn đề tồn 115
CHƢƠNG XÂY DỰNG MƠ HÌNH THỰC NGHIỆM, KIỂM CHỨNG,
ĐÁNH GIÁ CHẤT LƢỢNG BỘ ĐIỀU KHIỂN ĐÃ ĐỀ XUẤT 116
4.1 Phương pháp kiểm nghiệm điều khiển chạy thời gian
thực (Real time) 116
4.2 Xây dựng mơ hình thực nghiệm, kiểm chứng điều khiển MPC đề
xuất theo phương pháp HIL (Hardware In the Loop) 117 4.2.1 Cấu trúc mơ hình thực nghiệm HIL với điều khiển MPC 117 4.2.2 Thư viện mô thiết bị hàng hải MSS-GNC Toolbox 119 4.2.3 Card ghép nối Arduino Due R3, thư viện Arduino Libarary I/O 120 4.2.4 Ghép nối mơ hình thực nghiệm HIL, cài đặt thơng số với điều
khiển MPC đề xuất 122
(9)4.2.4.3 Ghép nối, cài đặt mơ hình đo tín hiệu quỹ đạo, hướng tàu GPS - Gyrocompass 123 4.2.4.4 Ghép nối, cài đặt Card Arduino Due R3 Atemega16u2
chuyển đổi tín hiệu NMEA0183 124 4.2.4.5 Mơ hình điều khiển MPC cài đặt máy tính (PC1) 124 4.2.4.6 Hình ảnh mơ hình vật lý thực nghiệm HIL với điều
khiển MPC đề xuất 126
4.3 Kết thực nghiệm, kiểm chứng điều khiển MPC đề xuất 127
4.4 Kết luận chương 132
KẾT LUẬN VÀ KIẾN NGHỊ 133 Những vấn đề giải 133
Những vấn đề tồn 133
(10)CÁC KÝ HIỆU ĐƢỢC SỬ DỤNG
Ký hiệu Ý nghĩa toán học/vật lý
T
u v p q r
Véc-tơ tổng quát vận tốc dài vận tốc góc hệ
tọa độ gắn với thân tàu (b-frame)
u Tốc độ trượt dọc tàu
v Tốc độ trượt ngang tàu
Tốc độ trượt đứng tàu
p Tốc độ lắc ngang tàu
q Tốc độ lắc dọc tàu r Tốc độ quay trở tàu
( )
C Ma trận Coriolis hướng tâm phương tiện Hàng hải ( )
A
C Ma trận Coriolis lực hướng tâm thủy động lực học
khối lượng nước kèm RB
C Ma trận Coriolis lực hướng tâm vật rắn D Ma trận suy giảm thủy động lực học tuyến tính
( )
n
D Ma trận suy giảm thủy động lực học phi tuyến
( )
D Ma trận suy giảm thủy động lực học
T
x y z
Véc-tơ vị trí hướng hệ tọa độ trái đất (e–frame)
x Tọa tàu theo hướng dọc trục x
y Tọa tàu theo hướng ngang trục y
z Tọa tàu theo hướng thẳng đứng trục z
Góc lắc ngang tàu
Góc lắc dọc tàu
Góc hướng tàu
d d d
d x y
Quỹ đạo véc-tơ vị trí hướng đặt hệ tọa độ trái
đất (e-frame) d d d
d u v r
(11)1( 2)
J Ma trận quay chuyển đổi vận tốc dài
2( 2)
J Ma trận quay chuyển đổi vận tốc góc
( )
J Ma trận quay chuyển đổi vận tốc dài vận tốc góc m Khối lượng vật rắn
A
M Ma trận quán tính hệ thống khối lượng nước kèm
RB
M Ma trận quán tính hệ thống vật rắn
2
T
Lực mô-men tác động lên thân tàu hệ tọa độ gắn
thân tàu (b-frame)
1 X Y Z
T
Lực tác động lên thân tàu hệ tọa độ (b-frame)
2 K M N
T
Mô men tác động lên thân tàu hệ tọa độ (b-frame)
Góc quay bánh lái (góc bẻ lái)
H
Lực mô-men thủy động lực học
w
Lực mơ-men nhiễu tác động bên ngồi (sóng, gió,
dịng chảy,…)
rd
Lực mơmen tạo tác động bánh lái sau
lái, bánh lái phụ trợ (Fin),…
P
Lực mô-men tạo tác động cấu đẩy
u
Lực gây cho tàu trượt dọc theo hướng theo trục x v
Lực gây cho tàu trượt ngang hướng theo trục y r
Mô-men quay trở tạo thay đổi hướng tàu
F Ma trận phân bổ lực ( , )
Các véc-tơ lực mô-men thành phần bất định
mơ hình tàu nhiễu loạn từ mơi trường bên ngồi
d Tín hiệu ước lượng bất định x
e , ey Sai lệch bám trục x , trục y
hd
e Sai lệch bám hướng
, , u v r
(12)BẢNG KÝ HIỆU VIẾT TẮT
Ký hiệu Tiếng Anh Tiếng Việt
DOF Degree Of Freedom Bậc tự
RHC Receding Horizon Control Bộ điều khiển trượt dọc theo trục thời gian
RBF Radial Basis Function Hàm hướng tâm
DP Dynamic Position Hệ thống ổn định động GPS Global Positioning System Hệ thống định vị toàn cầu ASV Autonomous Surface
Vessel Tàu tự hành ILC Iterative Learning Control Điều khiển học lặp BODY
Body–fixed reference frame
Khung tọa độ quy chiếu gắn với thân tàu
CG Center of gravity Tọa độ trọng tâm tàu SNAME Society of Naval Architects
and Marine Engineers
Hiệp hội kiến trúc hải quân hàng hải
DSC Dynamic Surface Control Điều khiển bề mặt động SMC Sliding Mode Control Điều khiển trượt
DWC Dynamic Window Control Điều khiển cửa sổ động LTI Linear Time Invariant Hệ tuyến tính tham số SQP Sequential Quadratic
Programming Tối ưu toàn phương GA Genetic Algorithm Thuật giải di truyền PSO Particle Swarm
Optimization Tối ưu bầy đàn
MPC Model Predictive Control Điều khiển dự báo theo mơ hình MPC-S Model Predictive Control -
State
Điều khiển dự báo phản hồi trạng thái cho hệ tiền định MPC-O Model Predictive Control -
Output
(13)DMPC-S Disturbance Model Predictive Control – State
Điều khiển dự báo phản hồi trạng thái cho hệ bất định DMPC-O Disturbance Model
Predictive Control – Output
Điều khiển dự báo phản hồi đầu cho hệ ngẫu nhiên, bất định EKF Extended Kalman Filter Thuật toán lọc Kalman mở rộng QSTT Quan sát trạng thái trực tiếp từ
mơ hình liên tục
MSS-GNC- Toolbox
Marine System Simulator – Guidance Navigation
Control –Toolbox
Hệ thống mô điều khiển, dẫn đường lĩnh vực Hàng hải
HIL Hardware In the Loop Thực nghiệm thời gian thực
NMEA National Marine Electronics Association
(14)DANH MỤC BẢNG
Bảng 1-1 Thành phần chuyển động tham số động học tàu thủy [28]
DANH MỤC HÌNH VẼ
Hình 1.1 Mơ tả trạng thái chuyển động tàu thủy [23] Hình 1.2 Các khung tọa độ quy chiếu [23] Hình 1.3 Mô tả động lực học tàu thủy khung tọa độ quy chiếu quán tính gắn với trái đất khung tọa độ gắn thân tàu [23] 10 Hình 1.4 Mơ tả thành phần chuyển động, thơng số động học chuyển động tàu thủy mặt phẳng ngang [23] 14 Hình 2.1 Cấu trúc nguyên lý làm việc hệ điều khiển dự báo [5] 34 Hình 2.2 Nguyên lý trượt dọc trục thời gian điều khiển dự báo 38 Hình 2.3 Tuyến tính hóa đoạn mơ hình song tuyến dọc trục thời gian 42 Hình 2.4 Ý nghĩa hiệu chỉnh tín hiệu đặt cho điều khiển dự báo [5] 44 Hình 2.5 Thuật tốn điều khiển dự báo phản hồi trạng thái (MPC-S), điều khiển chuyển động tàu thủy bám quỹ đạo đặt 55 Hình 2.6 Quỹ đạo đặt kiểm chứng chất lượng điều khiển 56 Hình 2.7 Kết mơ phỏng, kiểm chứng chất lượng điều khiển MPC-S với quỹ đạo hình trịn 59 Hình 2.8 Kết mô phỏng, kiểm chứng chất lượng điều khiển MPC–S với quỹ đạo hình sin 61 Hình 2.9 Cấu trúc điều khiển phản hồi đầu theo nguyên lý tách, điều khiển chuyển động tàu thủy bám quỹ đạo đặt 62 Hình 2.10 Quan sát trạng thái trực tiếp từ mơ hình liên tục tàu thủy ba bậc tự 64
Hình 2.11 Đồ thị mô kết QSTT tàu chạy quỹ đạo hình trịn
(15)(16)Hình 3.11 Cấu trúc điều khiển dự báo phản hồi đầu có bù bất định 105
Hình 3.12 Thuật toán điều khiển dự báo phản hồi đầu có bù bất định DMPC-O 106
Hình 3.13 Kết mô phỏng, kiểm chứng chất lượng điều khiển DMPC-O với quỹ đạo hình trịn 110
Hình 3.14 Kết mơ phỏng, kiểm chứng chất lượng điều khiển DMPC-O với quỹ đạo hình sin 113
Hình 4.1 Các phương pháp mơ thời gian thực 116
Hình 4.2 Cấu trúc lai mô thời gian thực 117
Hình 4.3 Cấu trúc mơ hình thực nghiệm HIL với điều khiển MPC đề xuất 118
Hình 4.4 Thư viện mơ hệ thống điều khiển Hàng hải MSS-GNC 119
Hình 4.5 Thư viện MSS-GNC Toolbox cài đặt Simulink-Matlab 120
Hình 4.6 Card ghép nối máy tính Arduino due R3 giao tiếp với Matlab 121
Hình 4.7 Thư viện Arduino I/O Matlab - Simulink 121
Hình 4.8 Mơ hình tàu thủy thư viện MSS - GNC Toolbox ghép nối cài đặt PC2 122
Hình 4.9 Mơ hình nhiễu đo tham số cài đặt 123
Hình 4.10 Mơ hình xác định quỹ đạo, hướng GPS- GYRO 124
Hình 4.11 Mơ hình điều khiển MPC cài đặt PC1 125
Hình 4.12 Hình ảnh mơ hình vật lý thực nghiệm phịng thí nghiệm Mơ hình hóa trường Đại học Hàng hải Việt Nam 127
(17)MỞ ĐẦU
1 Tính cấp thiết đề tài
Nghị số 36-NQ/TW chiến lược phát triển bền vững kinh tế biển Việt Nam đến năm 2030 tầm nhìn đến năm 2045 rõ: “ vấn đề khoa học, công nghệ, phát triển nguồn nhân lực biển tiếp cận, tận dụng tối đa thành tựu khoa học, cơng nghệ tiên tiến thuộc nhóm nước dẫn đầu ASEAN, có số lĩnh vực khoa học cơng nghệ biển đạt trình độ tiên tiến, đại giới Đào tạo phát triển nguồn nhân lực biển, hình thành đội ngũ cán khoa học cơng nghệ biển có lực, trình độ cao” Với chủ trương phát triển năm gần đây, sở nghiên cứu, nhà máy đóng tàu, doanh nghiệp vận tải biển nước không ngừng nâng cao lực thiết kế, đổi mặt công nghệ, áp dụng khoa học kỹ thuật tiên tiến để thiết kế đóng hàng loạt tàu chở hàng với trọng tải lớn, tàu nghiên cứu biển, tàu kiểm ngư, tàu chuyên dụng cảnh sát biển đội biên phòng,…
Cùng với phát triển khoa học kỹ thuật, bùng nổ công nghệ điện tử - tin học cách mạng công nghiệp 4.0 việc áp dụng trang thiết bị kỹ thuật, công nghệ tự động hóa tiên tiến, đại tàu thủy như: hệ thống lái tự động tàu thủy (Auto Pilot), hệ thống điều khiển chuyển động tàu theo quỹ đạo, hệ thống định vị tàu DP (Dynamic Position), hệ thống nghi khí Hàng hải định vị vệ tinh, hệ thống dẫn đường GPS (Global Positioning System), Radar, hệ thống tự động hóa buồng máy, hệ thống tự động hóa trạm phát điện nhằm cải thiện nâng cao chất lượng khai thác tàu thủy
(18)Neural, SMC - Backstepping, SMC - thích nghi để giải yếu tố bất định phức tạp mơ hình tàu nhằm nâng cao chất lượng điều khiển [14],…
Bài toán nghiên cứu điều khiển chuyển động tàu thủy đặt nhiều khó khăn, thách thức với nhà khoa học nghiên cứu, lý vì:
i) Tàu thủy phương tiện hàng hải hoạt động mơi trường phức tạp khơng có cấu trúc xác định, điều dẫn đến nhiễu loạn không dự báo hệ thống điều khiển, ví dụ dịng chảy đại dương, sóng gió…
ii) Mơ hình động lực học tàu thủy mơ hình phi tuyến bất định, tham số mơ hình tàu phụ thuộc vào biến trạng thái điều khiển [24] Phương trình tốn mơ tả chuyển động tàu thuỷ phương trình vi phân bậc cao, xét tính chất động học tàu thủy cho thấy đối tượng có tính chất như: q trình dao động, thời gian độ dài, độ dự trữ ổn định thấp
Tổng quan chung điều khiển chuyển động tàu thủy cho thấy điều khiển phi tuyến mang tính thời nghiên cứu, áp dụng vào điều khiển tàu thủy Việc tổng hợp điều khiển phi tuyến dựa hàm điều khiển Lyapunov, việc xác định hàm điều khiển Lyapunov phức tạp thách thức thiết kế điều khiển Các cơng trình nghiên cứu điều khiển chuyển động tàu thủy dừng lại việc giải vấn đề điều khiển đơn lẻ chưa có cơng trình giải kết hợp chung vấn đề như: bám quỹ đạo, ràng buộc tín hiệu điều khiển, sử dụng mơ hình có chứa thành phần bất định nhiễu tác động ngẫu nhiên,… điều khiển
Do phương pháp điều khiển để điều khiển chuyển động tàu thủy đáp ứng vấn đề làm phong phú thêm phương pháp điều khiển nâng cao chất lượng điều khiển chuyển động tàu thủy
2 Mục đích nhiệm vụ đề tài
Mục đích đề tài nghiên cứu ứng dụng điều khiển dự báo theo mơ hình MPC (Model Predictive Control) với nguyên tắc trượt dọc trục thời gian RHC (Receding Horizon Control), sở tuyến tính hóa đoạn mơ hình phi tuyến dọc trục thời gian để thiết kế điều khiển tàu thủy bám quỹ đạo, có ràng buộc tín hiệu mơ hình tốn có chứa thành phần bất định
(19)Nghiên cứu mơ hình tốn mô tả chuyển động tàu thủy dạng biến đổi khác mơ hình tốn Trên sở phân tích tổng quan phương pháp điều khiển chuyển động tàu thủy công bố ngồi nước năm gần đây, từ đặt hướng nghiên cứu cho luận án
Nghiên cứu lý thuyết điều khiển tối ưu có ràng buộc với điều khiển dự báo theo mơ hình MPC
Nghiên cứu xây dựng quan sát trạng thái ước lượng, bù thành phần bất định
Áp dụng nguyên lý điều khiển dự báo MPC sở tuyến tính hóa đoạn mơ hình phi tuyến để xây dựng điều khiển tàu có mơ hình toán dạng thiếu cấu chấp hành bám theo quỹ đạo đặt có ràng buộc tín hiệu mơ hình tàu có chứa thành phần bất định
Mơ thực nghiệm theo phương pháp HIL (Hardware In the Loop) để kiểm chứng điều khiển
3 Đối tƣợng phạm vi nghiên cứu luận án Đối tƣợng nghiên cứu đề tài:
Đối tượng nghiên cứu đề tài tàu nổi, choán nước, có mơ hình tốn dạng thiếu cấu chấp hành (Underactuated) toán điều khiển tàu bám theo quỹ đạo đặt
Phạm vi nghiên cứu đề tài là:
Nghiên cứu thiết kế điều khiển tàu bám theo quỹ đạo đặt với mơ hình toán tàu nổi, choán nước, ba bậc tự dạng thiếu cấu chấp hành xét mặt phẳng ngang có ràng buộc tín hiệu điều khiển bất định hàm đầu vào (khơng xét đến mơ hình cấu thực tàu) Mơ hình tốn mơ tả động lực học tàu thủy mặt phẳng ngang có chứa thành phần bất định, chịu ảnh hưởng yếu tố nhiễu ngẫu nhiên từ mơi trường ngồi Tàu hoạt động chế độ chạy kiểm tra tính điều động, quay trở, điều kiện hạn chế sóng, gió, dịng chảy…khơng lớn cấp 5, điều có nghĩa nhiễu ngẫu nhiên tác động từ mơi trường ngồi khơng lớn
4 Phƣơng pháp nghiên cứu
(20)Nghiên cứu, phân tích mơ hình tốn mơ tả động lực học tàu thủy mặt phẳng ngang Phân tích, đánh giá cơng trình nghiên cứu cơng bố ngồi nước báo, tạp chí, tài liệu tham khảo điều khiển chuyển động tàu thủy Đặc biệt phương pháp điều khiển áp dụng cho tàu nổi, chốn nước có mơ hình tốn dạng thiếu cấu chấp hành
Nghiên cứu lý thuyết điều khiển dự báo ứng dụng điều khiển dự báo sở tuyến tính hóa đoạn mơ hình phi tuyến để tổng hợp, thiết kế điều khiển
Kiểm chứng kết nghiên cứu mô Matlab - Simulink thực nghiệm theo phương pháp HIL
5 Ý nghĩa lý luận thực tiễn
Về mặt phương pháp luận, luận án hướng tới
Luận án đưa phương pháp luận, đề xuất áp dụng điều khiển phi tuyến để điều khiển chuyển động tàu thủy bám quỹ đạo đặt Cụ thể là, điều khiển theo nguyên lý RHC (trượt dọc trục thời gian), điều khiển dự báo MPC cho đối tượng tàu thủy, có mơ hình tốn dạng thiếu cấu chấp hành dựa kỹ thuật tuyến tính hóa đoạn mơ hình phi tuyến Luận án góp phần bổ sung làm phong phú thêm phương pháp điều khiển chuyển động tàu thủy
Về mặt thực tiễn luận án hướng tới
Kết luận án thực hóa vấn đề điều khiển chuyển động đối tượng có mơ hình tốn dạng thiếu cấu chấp hành bám theo quỹ đạo đặt Cụ thể tàu thủy, đối tượng có tính phi tuyến lớn, mơ hình có chứa thêm thành phần bất định có hai tác động điều khiển bánh lái chân vịt phía sau lái 6 Bố cục luận án
Luận án trình bày chương với nội dung tóm tắt sau: Chƣơng Mơ hình tốn tổng quan toán điều khiển chuyển động tàu thủy
Phân tích mơ hình tốn mơ tả động lực học tàu thủy Mơ hình tàu bậc, bậc tự xét mặt phẳng ngang dạng đủ thiếu cấu chấp hành
(21)Xác định đối tượng hướng nghiên cứu luận án
Chƣơng Điều khiển chuyển động tàu thủy bám quỹ đạo đặt với điều khiển dự báo có ràng buộc tín hiệu điều khiển mơ hình tàu xác định
Phân tích tổng quan điều khiển dự báo MPC, điều khiển dự báo hệ song tuyến sở tuyến tính hóa đoạn mơ hình phi tuyến dọc theo trục thời gian số giải pháp nâng cao chất lượng điều khiển dự báo
Các phương pháp tối ưu hóa có ràng buộc, giải pháp ràng buộc tín hiệu điều khiển với điều khiển MPC
Xây dựng điều khiển MPC phản hồi trạng thái MPC-S (Model Predictive Control - State) phản hồi đầu MPC-O (Model Predictive Control - Output) dựa kỹ thuật tuyến tính hóa đoạn mơ hình phi tuyến với quan sát trực tiếp từ mơ hình liên tục đề xuất áp dụng quan sát Kalman mở rộng (EKF) mơ hình tàu xác định
Chứng minh ổn định điều khiển đề xuất, mô kiểm nghiệm kết Chƣơng Điều khiển chuyển động tàu thủy bám quỹ đạo đặt với điều khiển dự báo mơ hình tàu có chứa thành phần bất định
Trên sở mơ hình tốn có chứa thành phần bất định, luận án xây dựng nhận dạng, ước lượng bù tín hiệu bất định
Thiết kế điều khiển, xây dựng thuật toán điều khiển dự báo phản hồi trạng thái có bù bất định DMPC-S (Disturbance Model Predictive Control - State) điều khiển dự báo phản hồi đầu có bù bất định DMPC-O (Disturbance Model Predictive Control - Output) Mô kiểm nghiệm kết điều khiển
Chƣơng Xây dựng mơ hình thực nghiệm, kiểm chứng, đánh giá chất lƣợng bộ điều khiển đề xuất
(22)CHƢƠNG MƠ HÌNH TỐN VÀ TỔNG QUAN BÀI TỐN ĐIỀU KHIỂN CHUYỂN ĐỘNG TÀU THỦY
Bài toán điều khiển chuyển động tàu thủy, giống toán điều khiển khác, việc phải hiểu biết, nắm rõ đặc tính động học đối tượng điều khiển quan hệ với môi trường xung quanh, trước tiến hành thiết kế điều khiển cho Kết q trình tìm hiểu đối tượng điều khiển thường mơ hình tốn mơ tả đặc tính động học Từ đó, dựa vào mơ hình tốn yêu cầu chất lượng điều khiển mong muốn người ta đề xuất phương pháp điều khiển thích hợp
Cũng lẽ đó, chương này, để trình bày tổng quan phương pháp điều khiển chuyển động tàu thủy có Trước tiên, luận án trình bày mơ hình động học động lực học tàu thủy từ mơ hình tổng qt mơ tả chuyển động tàu thủy sáu bậc tự do, ba bậc tự đủ thiếu cấu chấp hành, sau vào phân tích tổng quan phương pháp điều khiển nước áp dụng điều khiển chuyển động tàu thủy
1.1 Mơ hình tốn mô tả chuyển động tàu thủy
1.1.1 Mô tả chuyển động tàu thủy hệ quy chiếu
(23)Hình 1.1 Mơ tả trạng thái chuyển động tàu thủy [24]
Các thành phần chuyển động tham số động học tàu thủy mô tả chi tiết Bảng 1-1
Bảng 1-1 Thành phần chuyển động tham số động học tàu thủy [24]
STT Loại chuyển động Lực mô-men Véc-tơ vận tốc dài, vận
tốc góc
Vị trí góc Euler
1 trượt dọc (surge) X u x trượt ngang (sway) Y v y trượt đứng (heave) Z z lắc ngang (roll) K p
5 lắc dọc (pitch) M q
6 quay trở (yaw) N r
1.1.2 Các hệ quy chiếu
Nghiên cứu chuyển động tàu thủy thường gặp hệ quy chiếu mô tả Hình 1.2, gồm có:
Hệ quy chiếu ECI (i-frame) – hệ quy chiếu có khung tọa độ định vị trái đất
i i i
x y z , có gốc đặt tâm trái đất
Hệ quy chiếu ECEF (e-frame) – hệ quy chiếu có khung tọa độ qn tính
e e e
(24)Hệ qui chiếu NED (n-frame) – hệ quy chiếu có khung tọa độ địa lý x y z , n n n
gốc đặt bề mặt tiếp tuyến với trái đất, trục x hướng bắc, trục y hướng đông, trục
z hướng tới bề mặt trái đất
Hình 1.2 Các khung tọa độ quy chiếu [24]
Hệ quy chiếu BODY (b-frame) – hệ quy chiếu có khung tọa độ gắn với phương
tiện hàng hải cần khảo sát ox y z có gốc đặt trọng tâm tàu, trục x gắn b b b
hướng mũi tàu, trục y hướng ngang mạn tàu, trục z hướng thẳng đáy tàu
Dựa theo bảng 1.1, chuyển động tàu thủy mô tả véc-tơ sau [24]:
6 3
1 2
6 3
1 2
6 3
1 2
, ,
, ,
, X Y Z , K M N
T T T
T T T
T T T
R x y z R R
R u v R p q r R
R R R
trong đó:
– véc-tơ vị trí hướng hệ tọa độ trái đất (n-frame)
– véc-tơ vận tốc dài vận tốc góc hệ tọa độ gắn với thân tàu
(b-frame)
(25)1.1.3 Mơ hình tốn mơ tả chuyển động tàu thuỷ bậc tự
1.1.3.1 Mối quan hệ vị trí, hƣớng vận tốc chuyển động tàu thủy
Đạo hàm bậc véc-tơ vị trí
véc-tơ vận tốc dài 1 liên hệ
với qua biểu thức (1.1), [28]:
1J1( 2) (1.1) 1( 2)
J – ma trận chuyển đổi, đưa sau:
1 2
c( ) c( ) ( ) c( ) c( ) ( ) ( ) ( ) ( ) c( ) ( ) c( ) ( ) ( ) c( ) c( ) c( ) ( ) ( ) ( ) c( ) ( ) ( ) ( ) c( )
( ) c( ) ( ) c( ) c( )
s s s s s s
J s s s s s s s
s s (1.2)
trong (.)c cos(.), (.)s sin(.) Có thể thấy 1
2
( )
J ma trận trực giao, nghĩa là:
1( 2) 1( 2)
T
J J (1.3)
Mặt khác đạo hàm bậc
2
véctơ 2 có mối quan hệ (1.4):
2
2 J ( 2)
(1.4)
Ở ma trận 2
2
( )
J cho (1.5):
2 2
1 sin tan cos tan
( ) cos sin
0 sin cos cos cos
J (1.5)
Đối với phương tiện hoạt động mặt biển 2
2
( )
J ln hữu hạn, có hay cos 0
Kết hợp (1.1) (1.4) có mối quan hệ vị trí, hướng vận tốc chuyển động tàu thủy theo (1.6)
1 3
1
2 3
(26)1.1.3.2 Phƣơng trình mơ tả động lực học tàu thủy
Chuyển động phương tiện hàng hải (tàu thủy) mô tả giống chuyển động vật rắn môi trường chất lỏng hệ tọa độ gắn với vật rắn (b-frame) ox y z , trọng tâm vật rắn trùng với gốc tọa độ gắn vật rắn o , b b b
được mơ tả Hình 1.3
Phương trình mơ tả chuyển động tàu thủy môi trường Đại Dương biểu diễn sau [28]:
( )
RB RB RB
M C (1.7)
trong đó:
T
u v p q r
– véc-tơ tổng quát vận tốc dài vận tốc góc hệ
tọa độ gắn với thân tàu (b-frame)
Hình 1.3 Mơ tả động lực học tàu thủy khung tọa độ quy chiếu quán tính gắn với trái đất khung tọa độ gắn thân tàu [24]
RB
M – ma trận quán tính
RB
C – ma trận Coriolis hướng tâm
T
RB XY Z K M N
– véc-tơ tổng qt lực mơ-men phân tích
hệ tọa độ gắn với thân tàu (b-frame) Véc-tơ tổng quát lực, mô-men bao gồm thành phần RB H w
Trong đó:
H
(27)w
– lực mô-men nhiễu tác động từ bên ngồi (sóng, gió, dịng chảy,…)
– lực mô-men gây cầu thực tàu (chân vịt, bánh lái) Các thành phần lực mơ-men phân tích sau:
a Lực mômen thủy động lực học – H
Theo Faltinsen (1990) (được trích dẫn [27] tác giả Fossen) tàu thủy chuyển động môi trường biển chịu tác động lực mô-men thủy động lực học bao gồm: lực cảm ứng xạ lực ma sát bề mặt với nước, độ trơi, xốy nước
Thứ nhất, xét lực mômen cảm ứng xạ (ký hiệu R) bao gồm thành phần sau:
(i) Thành phần khối lượng nước kèm (added mass) quán tính chất lỏng xung quanh thân tàu gây đặc trưng ma trận M CA, A( ) (ii) Sự suy giảm năng lượng bị sóng biển, đặc trưng ma trận Dp( )
(iii) Lực phục hồi (do trọng lượng lực đẩy gây ra), thành phần tạo thành lực mơmen ký hiệu R tính sau:
( ) ( ) g( )
A A
R M C Dp
(1.8)
trong đó: A
M – ma trận qn tính khối lượng nước kèm
( )
A
C – ma trận coriolis hướng tâm thủy động lực học ( )
p
D – ma trận giảm chấn thủy động lực học ( )
g – lực mô-men phục hồi, lực sinh trọng lực tính tàu tác động nước lên thân tàu
Thứ hai, xét lực ma sát bề mặt với nước, độ trơi, xốy nước(ký hiệu
D
) sau:
(28)ký hiệu DW( ) giảm chấn bong bóng xoáy nước ký hiệu DM( ) , lực ma sát bề mặt với nước, độ trơi, xốy nước tính (1.9):
( ) ( ) ( )
S W M
D D D D
(1.9)
Từ (1.8), (1.9) ma trận giảm chấn thủy động lực học xác định tổng thành phần sau:
( ) P( ) S( ) W( ) M( )
D D D D D (1.10)
Nói chung ma trận giảm chấn thủy động lực học D( ) tàu biển chủ yếu giảm chấn năng, ma sát bên ngoài, giảm chấn ma sát với sóng giảm chấn bong bóng xốy Nhưng thật khó để đưa biểu thức chung ma trận giảm chấn thủy động lực học ( )D Tuy nhiên coi ma trận giảm chấn thủy động lực học ( )D gồm hai thành phần tuyến tính phi tuyến, (1.11):
( ) n( )
D D D (1.11)
Trong đó:
D – thành phần giảm chấn tuyến tính thủy động lực học ( )
n
D – thành phần giảm chấn phi tuyến thủy động lực học
b Lực mô-men nhiễu tác động từ bên – w
Lực mô-men tác động nhiễu loạn môi trường lên tàu bao gồm: sóng, gió, dịng chảy, Mơ hình nhiễu loạn luận án phân tích chi tiết phần phụ lục
c Lực mô-men tác động cấu đẩy –
Lực mô-men tác động cấu đẩy coi gồm thành phần sau: rd p
trong đó: rd
– lực mô-men tạo tác động bánh lái sau lái, bánh lái
phụ trợ (Fin)… p
– lực mô-men tạo tác động cấu đẩy (chân vịt) 1.1.3.3 Mơ hình tốn tàu thuỷ bậc tự
(29)( )
( ) ( ) ( ) w
J
M C D g
(1.12)
trong đó:
x y z T R6
– véc-tơ vị trí, hướng hệ tọa độ trái đất
(e-frame)
6
( )
J R – ma trận chuyển đổi u v w p q rT R6
– véc-tơ vận tốc dài vận tốc góc hệ tọa độ
gắn với thân tàu (b-frame)
RB A
M M M , MRB – ma trận quán tính, M – ma trận quán tính A khối lượng nước kèm (addmass)
( ) RB( ) A( )
C C C , CRB( ) ma trận coriolis hướng tâm, ( )
A
C ma trận coriolis hướng tâm thủy động lực học ( ) n( )
D D D , D – ma trận giảm chấn tuyến tính, Dn( ) – ma trận giảm chấn phi tuyến thủy động lực học
w
– nhiễu tác động vào tàu thủy bao gồm sóng, gió, dịng chảy đại dương,… – lực mô-men tạo cấu thực tàu bao gồm chân vịt, bánh lái
1.1.4 Mơ hình tốn mơ tả chuyển động tàu thủy ba bậc tự (xét mặt phẳng ngang)
(30)Hình 1.4 Mơ tả thành phần chuyển động, thông số động học chuyển động tàu thủy mặt phẳng ngang [24]
Mô tả chuyển động tàu thủy ba bậc tự do, xét mặt phẳng ngang đặc trưng bởi:
Véc-tơ vị trí hướng hệ tọa độ trái đất (e-frame) x yT R3 Véc-tơ vận tốc dài vận tốc góc hệ tọa độ gắn với thân tàu (b-frame) u v rT R3
Để có mơ hình tốn thể đầy đủ đặc trưng động lực học tàu thủy mặt phẳng ngang, giả định sau đưa ra:
Giả định với mơ hình tốn tàu thủy ba bậc tự [28]
(i) Tàu có khối lượng đồng đối xứng qua mặt phẳng mạn tàu (đối xứng qua mặt phẳng xz hệ tọa độ gắn với thân tàu)
(ii) Gốc tọa độ gắn với thân tàu (trong hệ tọa độ b-frame) trùng với trọng tâm tàu cho yg 0 (với yg – tọa độ trọng tâm tàu hệ tọa độ b-frame)
(iii) Nếu tốc độ tàu thấp bỏ qua ma trận giảm chấn phi tuyến Dn( ) , tàu chạy tốc độ cao khơng thể bỏ qua ma trận Dn( ) cơng thức (1.11) (trích theo tài liệu [28], trang 106)
Khi phương trình động lực học ba bậc tự mơ tả chuyển động tàu thủy mặt phẳng ngang theo [25] viết (1.13)
( )
( ) ( ) ( ) w
J
M C D g
(31)trong đó:
J – ma trận chuyển đổi ma trận trực giao J1 JT
khi tối thiểu hoá thành phần bậc tự xét mặt phẳng ngang (1.2), có ma trận chuyển đổi J sau:
cos sin ( ) sin cos
0
J (1.14)
Do xét thành phần chuyển động mặt ngang nên mơ-men qn tính Ixy Iyz 0, ma trận MRB, M ma trận M xác định A (1.15) (1.16)
0 0
0 ,
0 0
u
A u r RB g
r r g z
X m
M Y Y M m mx
Y N mx I
(1.15)
m 0
0 m m
0 m
u
A RB v g r
g r z r
X
M M M Y x y
x y I N
(1.16)
Các phần tử biểu thức (1.15), (1.16) ký hiệu theo SNAME 1950 (ký hiệu theo Hiệp hội kiến trúc hải quân hàng hải), ký hiệu sử dụng trong tài liệu [24] giải thích ví dụ như: lực Y khối lượng nước kèm, dọc theo trục y , với gia tốc u (hướng trục x ) viết là:
u,
u u Y
Y Y Y
u
, m – khối lượng tàu, I – mơ-men qn tính xung z
quanh trục z , zg– tọa độ trọng tâm tàu trục ozb hệ tọa độ (b-frame) Ma trận coriolis xét mặt phẳng ngang được cho (1.17):
0 m
0
m
g v r
u
g v r u
r
r
x v Y v Y r
C mu X u
x v Y v Y r mu X u
(32)Ma trận giảm chấn thủy động lực học D( ) xác định bao gồm: ( ) n( )
D D D Nếu tốc độ tàu thấp bỏ qua thành phần Dn( ) ma trận D( ) có thành phần tuyến tính D( ) D Dn( ) D Nếu tốc độ tàu cao khơng thể bỏ qua thành phần giảm chấn phi tuyến Dn( ) , ( )D gồm hai thành phần tuyến tính D phi tuyến Dn( ) , ,D Dn( ) xác định theo (1.18)
0
0
0 ,
0 0
u u u
v r n v v r v v r
v r v v r v v r r r
X u
X
D Y Y D Y v Y r Y v
N N N v N r N v N r
(1.18)
Các phần tử ma trận ,D Dn( ) (1.18) ký hiệu theo SNAME 1950 giải thích ví dụ sau:
2 v v v v Y Y (1.19)
– lực men tạo cấu thực tàu, lực mô-men cho (1.20)
u v rT
(1.20)
trong đó:
u
– lực làm cho tàu trượt dọc theo hướng trục x v
– lực làm cho tàu trượt ngang theo hướng trục y
r
– mô-men quay xung quanh trục z mặt phẳng xoy , gây thay đổi
hướng tàu
Theo Fossen [24], [28] mơ hình tàu bậc tự xét mặt phẳng ngang với mơ hình tốn (1.13), thành phần lực tác động có đầy đủ ba thành phần
, ,
u v r
(33)chính sau lái tạo mơ-men r thay đổi hướng tàu Mơ hình tốn thường gặp tàu cơng trình, tàu phục vụ nhiệm vụ đặc biệt biển,… Mơ hình tốn thường sử dụng nghiên cứu điều khiển ổn định động DP (Dynamic Position) cho tàu thủy Mơ hình tốn loại tàu phân tích sử dụng để thiết kế điều khiển tài liệu [23] - [29], cơng trình [15], [37], [42], [49], [52], [61], [71], [73], [76]
Mặt khác, u 0rTtức mơ hình tốn tàu khơng có thành phần lực gây trượt ngang v (phần tử thực khơng có cấu đẩy ngang) hướng theo trục y mơ hình tốn xét mặt phẳng ngang gọi mơ hình tàu thiếu cấu chấp hành (Underactuated) Giả thiết lực tác động bánh lái phía sau lái có thành phần lực gây trượt ngang nhỏ, điều khơng tính thực tế tàu khơng có dạt ngang q trình chuyển động Điều lý giải mơ hình tốn tàu thiếu cấu chấp hành trình bày đây, theo phương trình (1.21) tác động dạt ngang tạo thành phần ,u r Đây
mơ hình tốn đặc trưng cho loại tàu có cấu thực chân vịt bánh lái phía sau lái Nếu tàu có chân vịt mũi thực tế chân vịt mũi hoạt động chế độ tàu điều động vào cầu cảng Điều không làm ảnh hưởng hay tính tổng qt mơ hình tốn tàu thủy thiếu cấu chấp hành
Mơ hình toán tàu thủy thiếu cấu chấp hành thường gặp phổ biến tàu chở hàng, tàu Container,… Mơ hình tốn tàu thiếu cấu chấp hành thường sử dụng để nghiên cứu, thiết kế điều khiển tàu chuyển động theo quỹ đạo đặt, ổn định hướng xét mặt phẳng ngang Mơ hình tốn loại tàu phân tích sử dụng để thiết kế điều khiển tài liệu [10], [14], [16] - [22], [30], [35], [40], [41], [56], cơng trình [62] - [70]
1.1.5 Mơ hình tốn mô tả chuyển động tàu thủy ba bậc tự thiếu cấu chấp hành mặt phẳng ngang
(34)chuyển động tịnh tiến bánh lái (bánh lái phía sau lái) làm cho tàu chuyển động quay hướng, thiếu cấu thực làm chuyển động dạt ngang Để có mơ hình tốn mơ tả đầy đủ tính chất động học tàu thủy ba bậc tự dạng thiếu cấu chấp hành mặt phẳng ngang, giả định sau đưa ra:
Giả định với mơ hình tốn tàu ba bậc tự thiếu cấu chấp hành (theo
nguồn [21])
(i) Tàu có khối lượng đồng đối xứng qua mặt phẳng mạn tàu (đối xứng qua mặt phẳng xz )
(ii) Gốc tọa độ gắn với thân tàu, trùng với trọng tâm tàu cho yg 0 (với g
y – tọa độ trọng tâm tàu hệ tọa độ b-frame
(iii) Tàu thiếu cấu chấp hành thường có kết cấu mặt phẳng đối xứng nhau, trục khung tọa độ gắn thân tàu (b-frame) chọn cho trùng với trục theo dịng dịch chuyển chất lỏng Thực tế hầu hết tàu có mặt phẳng đối xứng mạn trái/phải, cịn đối xứng đỉnh/đáy khơng cần thiết cho chuyển động mặt phẳng ngang Sự không đối xứng đi/mũi tàu có nghĩa phần tử tốn hạng khơng đường chéo ma trận M D, ( ) khác Tuy nhiên toán hạng nhỏ so với phần tử đường chéo Điều dẫn tới giả định tàu thiếu cấu chấp hành xét mặt phẳng ngang bỏ qua phần tử không đường chéo ma trận M D, ( )
Với giả định trên, phương trình động lực học ba bậc tự mô tả chuyển động tàu thủy thiếu cấu chấp hành theo tài liệu [21] mô tả (1.21):
( )
( ) ( ) ( ) w
J
M C D g F
(1.21)
trong đó:
x y T R3
– véc-tơ tọa độ vị trí hướng hệ tọa độ trái đất
cos sin ( ) sin cos
0
J
(35)u v rT R3
– véc-tơ vận tốc dài (trượt dọc, trượt ngang) vận tốc góc
(tốc độ thay đổi hướng đi) hệ tọa độ gắn thân tàu (b-frame)
F – ma trận phân bổ lực (ma trận F kích thước 3x2, số hàng nhiều số cột
thể đặc điểm mơ hình thiếu cấu chấp hành), tàu thủy có cấu thực chân vịt bánh lái phía sau lái ma trận phân bổ lực
đưa sau:
1 0 0 F
– lực mô-men tạo cấu thực hiện, với ma trận phân bổ lực theo (1.21), u rT
Với giả định thành phần (1.21) xác định sau : Ma trận quán tính:
11 22
33
m 0 0
0 m 0
0 0
u
A RB v
z r
X m
M M M Y m
I N m
(1.23)
trong m11 m X mu, 22 m Y mv, 33Iz Nr Ma trận Coriolis:
22 11
22 11
0 m 0
0 0
m 0
v u
v u
v Y v m v
C mu X u m u
v Y v mu X u m v m u
(1.24)
Ma trận giảm chấn thủy động lực học:
11 22 33 ( ) 0 0 0 n d
D D D d
d (1.25)
trong thành phần giảm chấn tuyến tính D xác định (1.26)
11 22
33
0 0
0 0
0 0
u v
r
X d
D Y d
N d (1.26)
(36)Thành phần giảm chấn phi tuyến Dn( ) cho (1.27): 11 22 33 0 0 0 n n n n d D d d (1.27) đó:
2 ( 1)
11 11 ( 2) 11 ( 3)
2 22 22 ( 2) 22 ( 3)
3 ( 1)
2
2 33 33 (r 2) 33 ( 3)
3 ( 1)
2
( ) | |
( )
| |
( )
| r |
i
n n u n u u u uuu ui
i
n n v n v r v v v r v
i
vi r v
i
n n n r v r r
vvv
r v r
i ri
r
i
rr
d d d X u X u X u
d d d Y r X v X v Y
r
r
X v Y r
d d d N v X r X N v
X N
v r v
(1.28)
Những hệ số ma trận M (1.23) xác định xác hồn tồn sử dụng phương pháp bán kinh nghiệm chương trình tính tốn thủy động lực học, việc xác định hệ số ( 1)
2
| |i ui i X u
,
3 ( 1)
| |i
vi r v
i X v Y r
, ( 1)
2
| r |i
ri v r
i X N v
ma trận suy giảm thủy động lực học phi tuyến Dn( ) (1.28) khó khăn Có thể xác định chúng cách kéo tàu tốc độ khác theo hướng khác đo lực kéo tương ứng có khoảng nửa tham số xác định song việc khó tiến hành mơi trường biển
1.1.5.1 Mơ hình tốn mơ tả chuyển động tàu thủy ba bậc tự thiếu cấu chấp hành mặt phẳng ngang dạng mơ hình xác định
(37)ba nghĩa có thành phần d11 ( 2)n u ,d11 ( 3)n u , d22 (v 2)n ,d22 (v3)n , d33 (r 2)n ,d33 ( 3)n r xác định được, thành phần khó xác định coi không, coi ( ) 0g khơng có nhiễu tác động Cùng với giả định 2, mơ hình tốn mơ tả chuyển động tàu thủy ba bậc tự thiếu cấu chấp hành mặt phẳng ngang với mơ hình xác định sau [21]:
( )
( ) ( ) ( )
J
M C D g F
(1.29) đó: 11 22 33 0 0 0 m M m m (1.30)
1122
22 11
0
0
0
m v
C m u
m v m u
(1.31)
11 ( 2) 11 ( 3)
11 ( 2) 11
22 ( 3)
11 (r
33 2) 11 (r 3)
0
( ) 0
0
n u n u
n v n v
n n
d d
d d
d d d
d d D (1.32)
và ( )J xác định theo (1.22)
1.1.5.2 Mơ hình tốn bất định mô tả chuyển động tàu thủy ba bậc tự thiếu cơ cấu chấp hành mặt phẳng ngang
Những hệ số ma trận M (1.23) xác định xác thực tế tàu có khối lượng khơng đồng đều, tọa độ trọng tâm tàu không trùng với gốc tọa độ gắn với thân tàu Việc đưa công thức xác định thông số ma trận M C, ( ) dựa nhiều giả thiết, việc xác định hệ số:
3 ( 1)
| |i
ui
i X u
, ( 1)
2
| |i
vi r v
i X v Y r
, ( 1)
2
| r |i
ri v r
i X N v
(38)không thể tiến hành mơi trường biển Ngồi thành phần hệ số ma trận phụ thuộc vào yếu tố khác trọng tải hàng hóa tàu, phụ thuộc vào vùng nước tàu di chuyển qua Do đưa mơ hình tốn tàu thủy ba bậc tự dạng thiếu cấu chấp hành thể đầy đủ tính chất động học tàu cách gộp thành phần khó xác định nêu trên, thành phần bất định (không xác định) mơ hình tốn nhiễu từ mơi trường bên tác động vào đối tượng thành véc-tơ bất định, luận án ký hiệu ( , )
Khi mơ hình tốn mô tả chuyển động tàu thủy ba bậc tự thiếu cấu chấp hành mặt phẳng ngang có chứa thành phần bất định đưa sau [16], [18], [21]:
( )
( ) ( ) ( ) ( , )
J
M C D g F
(1.33) đó: ( , )
– véc-tơ lực mơ-men từ thành phần bất định mơ hình tàu
và nhiễu loạn tác động từ môi trường bên ngồi
Các thơng số ma trận M xác định theo (1.23), tham số ma trận
C xác định theo (1.24), tham số ma trận D( ) xác định theo (1.26), (1.27) (1.28), ( )J xác định theo (1.22)
Từ phương trình (1.21) đến (1.27) (1.33) với giả định 2, phương trình động học ba bậc tự mơ tả chuyển động tàu thủy thiếu cấu chấp hành mặt phẳng ngang với mơ hình bất định viết lại dạng khai triển sau:
11 22 11
11 11 11 11 11
22
11 22
22 22 22 22
33 33
11 22
33 33 33 33 33
1 ( , ) ( , ) 1 ( , ) n u u n v n r r
x ucos vsin
y usin vcos
r
d
m d
u vr u u
m m m m m
d
m d
v ur v v
m m m m
d d
m m
r uv r r
m m m m m
(39)đó:
( , ), ( , ), ( , )
u v r
– thành phần bất định mô hình tàu
nhiễu tác động từ mơi trường , ,
u v r – tốc độ trượt dọc, tốc độ trượt ngang, tốc độ quay trở
tàu , ,
x y – tọa độ vị trí theo trục ,x y góc hướng tàu hệ qui chiếu trái đất (e-frame)
, u r
– lực trượt dọc (được tạo chân vịt chính) mô-men quay trở (được tạo bánh lái phía sau lái)
Trong giới hạn nội dung nghiên cứu luận án, nghiên cứu sinh coi đối tượng tàu thủy có mơ hình tốn dạng thiếu cấu chấp hành, ba bậc tự mặt phẳng ngang đối tượng nghiên cứu luận án đề cập đến toán điều khiển cho đối tượng có mơ hình xác định dạng tổng qt (1.29) mơ hình bất định dạng tổng quát (1.33) dạng chi tiết (1.34)
1.2 Tổng quan nghiên cứu điều khiển chuyển động tàu thủy
1.2.1 Tình hình nghiên cứu nƣớc
Trong năm gần với phát triển ngành cơng nghiệp đóng tàu, điều khiển chuyển động tàu thủy nhà khoa học nước quan tâm, nghiên cứu Từ năm 1999 tác giả cơng trình [3] nghiên cứu ứng dụng kỹ thuật tự động hóa vi xử lý cho hệ thống lái tàu dùng cho tàu đóng Việt Nam, nhiên cơng trình nghiên cứu đề cập tới vấn đề điều khiển ổn định tàu theo hướng áp dụng mơ hình tàu dạng NOMOTO bậc tự
Tác giả cơng trình [7] thực nghiên cứu kiến trúc hướng mơ hình kết hợp với Real Time UML/MARTE thiết kế hệ thống điều khiển cho phương tiện không người lái tự hành mặt nước, khơng phải tàu thủy có người lái đối tượng thiếu cấu chấp hành
(40)dụng mơ hình tốn bậc tự Trong cơng trình tác giả tập hợp nhiễu bất định vào véc-tơ bất định dùng mạng Neural để nhận dạng nhiễu bất định
1.2.2 Tình hình nghiên cứu ngồi nƣớc
Tàu thủy đối tượng có tính phi tuyến lớn, hoạt động môi trường Đại Dương, chịu ảnh hưởng lớn yếu tố nhiễu ngẫu nhiên sóng, gió, dịng chảy hải lưu đặc biệt việc đo đạc, xác định tham số động học phức tạp khó khăn Với đặc thù đó, tàu thủy đối tượng nhiều nhà khoa học giới quan tâm, nghiên cứu ln thử thách thú vị cộng đồng nhà khoa học nghiên cứu điều khiển chuyển động tàu thủy
Những tác giả có nhiều cơng trình nghiên cứu điều khiển chuyển động tàu thủy điển tác giả Fossen T I [23] - [29], tác giả Lefeber E [39] - [41], tác gả Perez T [57], [58], tác giả Pettersen KY [56], tác giả Do K.D and J.Pan [16] - [21],…
Như đề cập mục 1.1 luận án, phân tích mơ hình tốn mơ tả chuyển động tàu thủy mặt phẳng ngang chia làm hai loại mơ hình: mơ hình tàu đủ cấu chấp hành (Full Actuated) mơ hình tàu thiếu cấu chấp hành (Underactuated) Để tổng quan chi tiết phương pháp điều khiển chuyển động tàu thủy cộng đồng nhà khoa học nghiên cứu, luận án trình bày tổng quan phương pháp điều khiển riêng cho nhóm đối tượng
1.2.2.1 Tổng quan điều khiển chuyển động tàu thủy đủ cấu chấp hành
Mơ hình tốn tàu đủ cấu chấp hành mơ hình tốn mà có số biến trạng thái với số tín hiệu điều khiển
(41)dụng điều khiển PID, mơ hình tốn sử dụng để thiết kế điều khiển mơ hình đơn giản hóa NOMOTO bậc một, bậc hai, hay điều khiển tuyến tính LQR (Linear Quadratic Regulator), LQG (Linear Quadratic Gaussin), với mơ hình máy lái bậc hai tuyến tính hóa từ mơ hình phi tuyến
Khi lý thuyết điều khiển phi tuyến phát triển ứng dụng mơ hình tàu phi tuyến điều khiển phi tuyến Backstepping [23], [71], điều khiển trượt SMC (Sliding Mode Control) [37], [47], điều khiển bề mặt động DSC (Dynamic Surface Control) [61], điều khiển cửa sổ động DWC (Dynamic Windown based Control) [49], điều khiển dự báo MPC (Model Predictive Control) [52], điều khiển thích nghi [42],…được áp dụng để thiết kế điều khiển chuyển động tàu thủy với mơ hình tốn tàu dạng đủ cấu chấp hành
Nhằm nâng cao chất lượng điều khiển sử dụng mơ hình tàu có xét đến yếu tố bất định nhiễu loạn từ mơi trường ngồi điều khiển kép như: Backstepping - Neural [15], [73], [76], Backstepping - thích nghi [61], Backstepping - trượt thích nghi [37], sử dụng
Tổng hợp điều khiển từ cơng trình với mơ hình đủ cấu chấp hành thấy điều khiển sử dụng đa dạng Từ việc sử dụng điều khiển tuyến tính cách đơn giản hóa mơ hình đến điều khiển phi tuyến với mơ hình tàu phi tuyến xác định, điều khiển phi tuyến kép để giải thành phần bất định mơ hình tàu nhiễu loạn từ môi trường nhằm nâng cao chất lượng điều khiển chuyển động tàu đủ cấu chấp hành
1.2.2.2 Tổng quan điều khiển chuyển động tàu thủy thiếu cấu chấp hành Mơ hình tốn tàu thủy dạng thiếu cấu chấp hành có đặc điểm số tín hiệu điều khiển số biến trạng thái cần điều khiển Mơ hình loại tàu bắt đầu nhà khoa học nghiên cứu, thiết kế điều khiển từ cuối kỷ XX (theo thống kê tài liệu [28] trang 5)
(42)được viết nhiều dạng khác Với mục đích phù hợp thiết kế điều khiển như: mơ hình đơn giản hóa NOMOTO bậc một, NOMOTO bậc hai, mơ hình Norrbin [24], mơ hình tuyến tính máy lái, mơ hình phi tuyến ba bậc tự mặt phẳng ngang có mơ hình xác định, mơ hình phi tuyến ba bậc tự mặt phẳng ngang có chứa thành phần bất định
Mơ hình dạng NOMOTO bậc một, bậc hai, mơ hình Norrbin hay mơ hình tuyến tính máy lái thường sử dụng để thiết kế điều khiển lái tự động với chức ổn định tàu theo hướng cho trước tính chất đơn giản hóa mơ hình Trong cơng trình [50] tác giả thiết kế điều khiển Fuzzy-LQR cho hệ lái tự động (chỉ ổn định tàu theo hướng cho trước) với tàu tự hành USV (Unmanned Surface Vessel) sử dụng mơ hình tuyến tính hóa Dựa mơ hình NOMOTO tác giả cơng trình [36] xây dựng điều khiển tàu ổn định theo hướng sử dụng mạng Neural thích nghi theo mơ hình mẫu, nhiễu loạn bất định từ mơi trường ngồi xấp xỉ mạng Neural Tác giả cơng trình [66] sử dụng mơ hình phi tuyến đơn giản hóa Norrbin để thiết kế điều khiển tàu ổn định theo hướng cho trước với điều khiển trượt SMC - Backstepping, nhiễu loạn bất định từ môi trường ước lượng quan sát nhiễu phi tuyến Bộ điều khiển theo luật điều khiển H thiết kế dùng cho tàu thủy thiếu cấu chấp hành với mục đích ổn định, giảm lắc ngang tàu Container cơng bố cơng trình [34]
(43)định mơ hình động học tàu thủy nhiễu tác động từ mơi trường ngồi khơng xem xét đến Cơng trình [16] tác giả thiết kế điều khiển tàu thủy bám quỹ đạo dựa hàm Lyapunov kỹ thuật Backstepping Để kết điều khiển đạt ổn định quỹ đạo đầu bám theo toàn quỹ đạo đặt, giả thiết cơng trình đưa tín hiệu điều khiển phải khơng có ràng buộc độ lớn Cũng tác giả cơng trình [16] cộng sau phát triển điều khiển đa biến để điều khiển tàu thủy ổn định toàn quỹ đạo đặt, giảm lắc ngang lắc dọc, thuật tốn chiếu liên tục Lipschitz sử dụng để cập nhật ước lượng nhiễu không xác định đưa cơng trình [17] Trong cơng trình [22] tác giả đề xuất phương pháp điều khiển tàu bám theo quỹ đạo đặt với yêu cầu ràng buộc tín hiệu điều khiển đầu vào độ lớn tốc độ, sử dụng phương pháp điều khiển bề mặt động DSC mơ hình tốn sử dụng để thiết kế điều khiển coi khơng chứa yếu tố bất định Cơng trình [46], phương pháp điều khiển dựa đại số tuyến tính đề xuất để thiết kế điều khiển bám theo quỹ đạo đặt cho tàu thiếu cấu chấp hành Bộ điều khiển thiết kế dựa việc tuyến tính hóa mơ hình phi tuyến đối tượng điều khiển Tín hiệu điều khiển tính tốn dựa việc xác định điều kiện để hệ phương trình tuyến tính hóa có nghiệm cuối tín hiệu điều khiển có giải hệ phương trình tuyến tính hóa Tuy nhiên điều khiển tác giả không đề cập tới vấn đề nhiễu tác động yếu tố phi tuyến bất định mơ hình động lực học tàu thủy
(44)trong mơ hình Tác giả [69] đề xuất điều khiển chuyển động tàu bám theo quỹ đạo đặt dùng cho tàu tự hành sử dụng lọc Kalman UKF (Unscented Kalman Filter) để loại bỏ nhiễu ẩn mơ hình tốn đối tượng kết hợp với thuật điều khiển xây dựng dựa kỹ thuật Backstepping Trong [67] tác giả xây dựng điều khiển phản hồi đầu để điều khiển tàu thiếu cấu chấp hành dựa phương trình Euler-Lagrange Trong phương pháp biến đổi tọa độ sử dụng để khắc phục thành phần bất định bậc ba phát sinh dẫn xuất hàm Lyapunov thành phần lực Coriolis lực hướng tâm gây Bộ điều khiển thiết kế dựa kỹ thuật Backstepping, lý thuyết ổn định hàm Lyapunov quan sát trạng thái đưa dựa phép biến đổi tọa độ Trong [70] tác giả đề xuất điều khiển dựa kỹ thuật Backstepping chế độ trượt động DSC để điều khiển bám quỹ đạo cho tàu thiếu cấu chấp hành Bộ điều khiển có xét đến sai lệch mơ hình nhiễu bất định từ mơi trường ngồi Mơ hình sử dụng để thiết kế điều khiển gồm mơ hình tàu phi tuyến phương trình động lực học sai lệch Serret-Frenet Thông qua hàm Lyapunov, tác giả chứng minh điều khiển đề xuất ổn định tiệm cận
(45)trình mơ hình tốn sử dụng phương trình, điều làm tăng thêm phức tạp thiết kế điều khiển
Gần lý thuyết điều khiển dự báo MPC nghiên cứu ứng dụng Nhiều tác giả nghiên cứu áp dụng vào điều khiển chuyển động tàu thủy Trong [53] điều khiển với mục đích ổn định tàu theo hướng cho trước với đường ngắm LOS (Line-Of-Sight) tạo dựa ngun lý mơ hình dự báo MPC Mơ hình động học tàu thủy ba bậc tự sử dụng để thiết kế điều khiển mơ hình đơn giản hóa, xét mặt phẳng ngang với hai biến trạng thái tốc độ tàu hướng Để đầu (hướng tàu) bám theo hướng đặt, hàm mục tiêu dạng toàn phương QP (Quadratic Programming) sử dụng điều khiển MPC cách tuyến tính hóa liên tục dọc theo đường ngắm LOS tàu Trong [62] đề xuất điều khiển dự báo theo mơ hình phi tuyến NMPC (Nonlinear Model Predictive Control) để điều khiển bám quỹ đạo tàu thiếu cấu chấp hành có xét đến điều kiện bão hịa tín hiệu điều khiển đầu vào Bộ điều khiển NMPC xây dựng để tính tốn tín hiệu điều khiển dự báo đầu vào tương lai dựa biến trạng thái cách tối ưu hóa hàm chức Mơ hình tốn sử dụng để thiết kế điều khiển mơ hình tàu thiếu cấu chấp hành đơn giản hóa khơng xét đến thành phần bất định mơ hình Trong [48], tác giả xây dựng điều khiển dự báo theo mô hình phi tuyến NMPC để điều khiển tàu bám theo quỹ đạo đặt có xét đến điều kiện ràng buộc tín hiệu điều khiển đầu vào Mơ hình tốn sử dụng để thiết kế điều khiển mô hình tàu bậc tự thiếu cấu chấp hành tác giả coi mơ hình khơng có thành phần bất định tất biến trạng thái giả thiết phải đo đạc xác định hoàn toàn
(46)Một điều khiển bám theo quỹ đạo đặt cho tàu thiếu cấu chấp hành dựa mạng Neural mơ hình trượt phân cấp đề xuất [14] Trong mơ hình trượt phân cấp sử dụng để giải vấn đề thiếu tác động điều khiển cấu chấp hành mơ hình Mạng Neural sử dụng công cụ để xấp xỉ hàm phi tuyến bất định mơ hình tốn đối tượng Với phương pháp này, bền vững điều khiển đề xuất khẳng định vấn đề rung (chattering) thường xuất điều khiển trượt giải Trong mơ hình tốn phần tử giảm chấn phi tuyến mơ hình tàu xem xét xấp xỉ mạng Neural mà trước chúng bị bỏ qua nhiều nghiên cứu Các nhiễu bất định xem xét đến để kiểm tra độ bền vững điều khiển Tuy nhiên vấn đề thỏa mãn ràng buộc tín hiệu điều khiển khơng tác giả đề cập đến Trong [68] tác giả đề xuất điều khiển dựa chế độ trượt thích nghi để điều khiển tàu bám theo quỹ đạo đặt, kết hợp với quan sát nhiễu phi tuyến bất định NDO (Nonlinear Disturbance Observer) để ước lượng nhiễu bất định, sau tín hiệu ước lượng bù vào tín hiệu điều khiển Bộ điều khiển có xét đến tham số phi tuyến bất định mơ hình tàu Vấn đề rung (Chattering) điều khiển chế độ trượt cải thiện việc áp dụng lý thuyết lớp biên phương pháp thích nghi để điều chỉnh độ dày lớp biên điều khiển
Bộ quan sát nhiễu phi tuyến bất định NDO [68] áp dụng công trình [75], tác giả sử dụng thuật tốn điều khiển chế độ trượt thích nghi quan sát nhiễu phi tuyến NDO để xây dựng điều khiển với mục đích ổn định tàu theo hướng cho trước giả thiết tốc độ tàu không đổi
(47)Tổng hợp phương pháp điều khiển áp dụng với mơ hình tàu thiếu cấu chấp hành đa dạng phong phú như: phương pháp điều khiển tuyến tính LQR, PID,…với mơ hình đơn giản hóa NOMOTO hay mơ hình tuyến tính hóa từ mơ hình phi tuyến mơ hình giúp để thiết kế điều khiển ổn định tàu theo hướng cho trước Phương pháp điều khiển phi tuyến điều khiển trượt SMC, điều khiển động DSC, Backstepping,…kết hợp với quan sát nhiễu Kalman (UKF), NDO,… Để giải tốn điều khiển mơ hình tàu có chứa thành phần bất định, nhiễu loạn từ mơi trường ngồi điều khiển kép như: điều khiển SMC kết hợp Neural, điều khiển thích nghi kết hợp Neural, SMC - thích nghi, trượt thích nghi kết hợp quan sát phi tuyến, thích nghi Neural kết hợp trượt – Backstepping sử dụng nhằm nâng cao chất lượng điều khiển
1.3 Hƣớng nghiên cứu luận án
1.3.1 Vấn đề đặt luận án
Từ phân tích tổng quan phương pháp điều khiển chuyển động tàu thủy đủ thiếu cấu chấp hành cho thấy: Các điều khiển sử dụng từ kinh điển đến điều khiển đại Kết là, có nhiều phương pháp điều khiển, điều khiển mang tính thời cách điều khiển khác áp dụng vào chuyển động tàu thủy Từ mô hình tàu tuyến tính, phi tuyến đơn giản hóa, đến mơ hình tàu phi tuyến phức tạp có xét đến yếu tố bất định mơ hình
Các cơng trình nghiên cứu điều khiển chuyển động tàu thủy dừng lại việc giải vấn đề điều khiển đơn lẻ chưa có cơng trình giải kết hợp chung vấn đề như: bám quỹ đạo, ràng buộc tín hiệu điều khiển, sử dụng mơ hình có chứa thành phần bất định nhiễu tác động ngẫu nhiên,… điều khiển
(48)trượt dọc trục thời gian (receding horizon) [54], điều khiển MPC tuyến tính áp dụng cho đối tượng phi tuyến dựa kỹ thuật tuyến tính hóa đoạn mơ hình phi tuyến dọc trục thời gian
1.3.2 Ý nghĩa vấn đề ràng buộc tín hiệu điều khiển
Đối với tàu thủy có cấu thực gồm chân vịt bánh lái phía sau lái (thường loại tàu chở hàng) góc bẻ lái (ký hiệu ) giới hạn khoảng 0
35 (port) 35 (s.t board) (góc bẻ lái giới hạn từ 35 độ trái đến 35 độ phải) Còn chế độ lái tự động góc bẻ lái ln giới hạn
khoảng 0
10 (port) 10 (s.t board) Ở phương pháp điều khiển chuyển động tàu thủy có trình bày trên, kể mơ hình đủ hay thiếu cấu chấp hành, điều kiện ràng buộc tín hiệu góc bẻ lái bắt buộc phải thỏa mãn chuyển sang phần nhiệm vụ cấu chấp hành thơng qua thiết bị hạn chế tín hiệu (saturation devices) Điều dẫn tới vấn đề thiết kế điều khiển, để đạt mục tiêu điều khiển tàu bám theo quỹ đạo đặt góc bẻ lái có phải lớn giá trị quy định góc bẻ lái nhiều Do vấn đề ràng buộc tín hiệu điều khiển góc bẻ lái cần phải đặt nghiên cứu thiết kế điều khiển chuyển động tàu thủy
1.4 Kết luận chƣơng
Trong chương 1, luận án giải nội dung:
Phân tích mơ hình tốn mơ tả động lực học chuyển động tàu thủy bậc tự do, bậc tự mặt ngang Mơ hình tàu thủy bậc tự đủ thiếu cấu chấp hành dạng mơ hình xác định coi khơng có nhiễu tác động tham số mơ hình tàu xác định hồn tồn Đề xuất mơ hình tàu thủy bất định bậc tự mặt phẳng ngang thiếu cấu chấp hành cách gộp thành phần bất định mơ hình nhiễu ngẫu nhiên tác động từ mơi trường ngồi thành véc-tơ hàm bất định
(49)CHƢƠNG ĐIỀU KHIỂN CHUYỂN ĐỘNG TÀU THỦY BÁM QUỸ ĐẠO ĐẶT VỚI BỘ ĐIỀU KHIỂN DỰ BÁO CÓ RÀNG BUỘC TÍN HIỆU ĐIỀU
KHIỂN KHI MƠ HÌNH TÀU XÁC ĐỊNH
Với mục đích nghiên cứu luận án đặt nhiệm vụ luận án thiết kế điều khiển chuyển động tàu thủy bám theo quỹ đạo đặt tín hiệu điều khiển bị ràng buộc điều kiện (2.1), cho đối tượng tàu có mơ hình tốn dạng thiếu cấu chấp hành, mơ hình có chứa thành phần bất định nhiễu tác động ngẫu nhiên
1( , ) 2( , )
b b a b (2.1)
trong – lực mô-men tạo cấu thực (chân vịt bánh lái phía sau lái), theo (1.21) u rT, a b – giá trị giới hạn tín hiệu điều khiển , bị ràng buộc
Trên sở nhận xét vậy, nghiên cứu sinh định hướng sử dụng nguyên lý điều khiển dự báo [5], [13], [32], [45], [59] để giải nhiệm vụ điều khiển đặt cho luận án Nguyên lý dựa phương pháp tối ưu hóa có ràng buộc [51], [55] điều khiển tối ưu có ràng buộc [5] nên hồn toàn đáp ứng yêu cầu giải trực tiếp điều kiện ràng buộc (2.1) tín hiệu điều khiển
(50)Với định hướng đặt đó, đây, chương trước vào thiết kế cụ thể điều khiển dự báo, luận án trình bày nguyên lý chung về:
Điều khiển dự báo, điều khiển dự báo hệ song tuyến sở tuyến tính hóa đoạn mơ hình phi tuyến dọc theo trục thời gian Các phương pháp nâng cao chất lượng điều khiển dự báo phương pháp tối ưu hóa có ràng buộc
Tiếp theo, luận án vào chi tiết nội dung phần thiết kế điều khiển dự báo phản hồi trạng thái, phản hồi đầu mơ hình tàu có tham số xác định (không chứa thành phần bất định) để chuyển động tàu thủy bám theo quỹ đạo đặt Cũng phần thiết kế điều khiển này, luận án đề xuất xây dựng quan sát trạng thái từ mơ hình liên tục đối tượng
2.1 Nguyên lý điều khiển dự báo
2.1.1 Cấu trúc điều khiển dự báo
Đối tƣợng điều khiển Mơ hình dự báo Tối ƣu hóa Bộ điều khiển
dự báo k y k x k u k i y
k
Cửa sổ dự báo tại
Cửa sổ dự báo tiếp theo t
k k1 k N 1
Hàm mục tiêu
a) b)
Hình 2.1 Cấu trúc nguyên lý làm việc hệ điều khiển dự báo [5]
Hình 2.1 mơ tả cấu trúc điều khiển dự báo nguyên lý làm việc trượt dọc trục thời gian nó, theo tài liệu [5], [54] Cấu trúc gồm khối khối mơ hình dự báo, khối hàm mục tiêu khối tối ưu hóa (Hình 2.1a) Chúng thiết kế dựa mơ hình tốn dạng rời rạc đối tượng điều khiển dạng (2.2):
1 ( , ) ( )
k k k
k k
x f x u
y g x
(2.2)
(51) 1( ), 2( ), , ( ) T
a a n a
k
x x kT x kT x kT – véc-tơ trạng thái 1( ), 2( ), , ( )
T
a a m a
k
u u kT u kT u kT U – véc-tơ tín hiệu đầu vào 1( ), 2( ), , ( )
T
a a r a
k
y y kT y kT y kT – véc-tơ tín hiệu đầu a
T – chu kỳ trích mẫu
( k, k) ( k, k), ( k, k), , n( k, k) T
f x u f x u f x u f x u – véc-tơ hàm trạng thái
( k, k) ( k, k), ( k, k), , r( k, k) T
g x u g x u g x u g x u – véc-tơ hàm đầu
và làm việc theo nguyên lý trượt dọc trục thời gian (Hình 2.1b) 2.1.1.1 Khối mơ hình dự báo
Khối có nhiệm vụ sau Tại thời điểm k tại, dựa vào mơ hình tốn (2.2) đối tượng điều khiển, xác định truy hồi đầu tương lai
, 1, , k i
y i N (với N số cửa sổ dự báo) thuộc cửa số dự báo Chẳng hạn như:
1
1
2 1
2
2
1
khi 1: ( ) ( , ) ( , )
khi : ( ) ( , ) ( ( , ), ) ( , , )
khi : ( , , , , )
k k k k k
k
k k k k k k
k
k k k
N k k k k N
k N
i y g x g f x u h x u
i y g x g f x u g f f x u u
h x u u
i N y h x u u u
(2.3)
Như vậy, tất đầu dự báo này, tính từ thời điểm k mà trạng thái x biết đo quan sát được, hàm phụ k
thuộc vào đầu vào tương lai u uk, k1, ,uk N 1
Ký hiệu tập tất đầu tương lai theo biến mới:
1
col k, k , , k N
p u u u (2.4)
(52)1 2 ( ) ( ) ( ) ( ) ( ) k k k N k N
y h p
y h p
p p h p y
y h (2.5)
đó véc-tơ hàm dự báo đầu phụ thuộc p đầu vào tương lai 2.1.1.2 Khối hàm mục tiêu
Khối hàm mục tiêu xây dựng từ nhiệm vụ điều khiển đặt mà tín hiệu đầu y hệ phải bám theo tín hiệu đặt k w mong muốn, tức k
phải tạo được:
lim ( )
ke p 0 ( )e p yk( )p w k
1 k k k N w w
w (2.6)
Có thể thấy hàm mục tiêu đáp ứng yêu cầu [5], [13], [32], [45]:
( ) ( )T ( ) T
k k k
p
J p e p Q e p p R p (2.7)
trong Q R hai ma trận đối xứng xác định dương tùy chọn Thông qua việc k, k chọn hai tham số ta can thiệp thêm vào chất lượng điều khiển ngồi việc bám theo tín hiệu đặt (2.6) nêu Chẳng hạn Q chọn lớn, k
thời gian độ ngắn, R chọn lớn, tín hiệu điều khiển k
k
u tối ưu tìm sau nhỏ [1], [2], [5]
2.1.1.3 Khối tối ƣu hóa
Khối tối ưu hóa có nhiệm vụ tìm nghiệm tối ưu tốn tối ưu có ràng buộc:
* arg k( )
p P
p J p
(2.8)
với tập ràng buộc là:
col k, k 1, , k N k j , 0,1, , 1
(53)trong U tập giá trị điều kiện ràng buộc tín hiệu điều khiển toán Chẳng hạn toán điều khiển hệ lái tự động tàu thủy với điều kiện ràng buộc (2.1) tín hiệu điều khiển gán uk , tập ràng buộc U là:
k n k
U u R a u b (2.10)
Phương pháp tìm nghiệm tối ưu p cho tốn (2.8) có ràng buộc (2.9) bao gồm * phương pháp truyền thống giới thiệu tài liệu [5], [11], [51], phương pháp tối ưu tiến hóa cho [38], [43], [74]
Sau có nghiệm p tối ưu tín hiệu điều khiển * u cho hệ (2.2) thời k điểm k là:
2, 2 2(N 1) *
k
u I 0 p (2.11)
2.1.1.4 Nguyên lý trƣợt dọc trục thời gian
Tất cơng thức tính bao gồm: dự báo đầu (2.5), hàm mục tiêu (2.7) tối ưu hóa (2.8) điều khiển dự báo dựa vào giá trị trạng thái x đo k
từ hệ thống thời điểm k cho kết tín hiệu điều khiển u k
ở thời điểm Bởi vậy, sau đưa u vào điều khiển đối tượng, để xác định k
được uk1 cho thời điểm k1, tất bước tính trên, nguyên tắc, phải lặp lại Nguyên tắc tính lặp gọi điều khiển trượt dọc trục thời gian RHC (Receding Horizon Control)
Tất nhiên, tùy thuộc vào độ đơn giản hay phức tạp mơ hình tốn mô tả đối tượng (2.2) mà vài công thức tính số cơng thức (2.5), (2.7), (2.8) dùng chung cho tất vòng lặp Chẳng hạn hệ tuyến tính tham số LTI (Linear Time Invariant) hai cơng thức dự báo (2.5) hàm mục tiêu (2.7) dùng chung cho tất vòng lặp, riêng việc tối ưu hóa (2.8), cịn phụ thuộc giá trị trạng thái đo x , phải lặp lại Hoặc hệ song k tuyến, công thức hàm mục tiêu (2.7) dùng chung được, cịn cơng thức dự báo (2.5) tối ưu hóa (2.8) lặp lại vòng lặp
(54)với tính trượt dọc trục thời gian có tên gọi chung RHC
Dự báo tín hiệu đầu ra cho tồn cửa
sổ dự báo tại Đo trạng thái
đầu hệ Khởi tạo
Xác định hàm mục tiêu tìm nghiệm
tối ƣu nó
Đƣa vào điều khiển đối tƣợng
chu kỳ trích mẫu
Cửa sổ dự báo tại
Cửa sổ dự báo tiếp theo
t
a
kT (k1)Ta (k N T ) a
một vòng lặp
Hình 2.2 Nguyên lý trượt dọc trục thời gian điều khiển dự báo
2.1.2 Điều khiển dự báo hệ tuyến tính phản hồi trạng thái
Phương pháp sử dụng mô hình trạng thái (2.12) hệ LTI sau:
1
k k k
k k
x Ax Bu
y C x
với , ,
n n n m r n
AR BR CR (2.12)
Để tăng chất lượng bám người ta thường bổ sung thêm vào điều khiển thành phần tích phân Điều thực cách xây dựng mơ hình dự báo từ mơ hình tương đương với (2.12), viết lại để xuất thành phần tích phân cách chuyển thành mơ hình có tín hiệu đầu vào
1
k k k
u u u
,
1
1
1
k k k k
k k k
k
k k
k
x Ax Bu B u
u u u
y C x C x u
0
,
hay 1
1
k k
k k k k
k k
k
x A B x B
z u Az B u
u I u I
z B A
(55)và yk C , zk C zk
C
0 (2.14)
Sử dụng mơ hình (2.13), (2.14) ta đầu dự báo yk i , i 1, 2, ,N xác định truy hồi từ z sau: k
1
1
i i i
k i k k k k i
y CA z CA B u CA B u CB u vậy, viết chung lại theo cấu trúc véc-tơ dự báo đầu (2.5), được:
1 2 k k k k k k
N N k N N
k N
k
y CB u CA
y CAB CB u CA
z
u
y CA B CA B CB CA
p H 0 0 y b (2.15)
trong véc-tơ b xác định từ giá trị vào hệ khứ k
(khơng phụ thuộc vào tín hiệu điều khiển tương lai p )
Cùng với véc-tơ đầu dự báo, hàm mục tiêu (2.7) trở thành:
( ) T T T T
k k k k k k k k k k k
J p p H Q H R p b w Q H p b w Q b w (2.16) Do đó, trường hợp tốn điều khiển khơng có điều kiện ràng buộc, nghiệm tối ưu (2.8) là:
* arg k( ) T k k T k k k
p J p H Q H R H Q b w
Suy tín hiệu điều khiển u thời điểm k là: k
1 I,0, ,0
T T
k k k k k k k
u u H Q H R H Q b w (2.17)
2.1.3 Giải pháp điều khiển dự báo hệ song tuyến sở tuyến tính hóa từng đoạn mơ hình phi tuyến dọc theo trục thời gian
(56)việc xác định hàm hợp phi tuyến cho (2.3), tức phải tìm hàm ( )hi
trong (2.18):
1 2
1
( ) ( , ) ( ( , ), )
( , , , , )
k i k i k i k i k i k i
k i
i k k k k i
y g x g f x u g f f x u u
h x u u u
(2.18)
từ mơ hình phi tuyến hệ cho tất số i 1, 2, ,N Một giải pháp cho vấn đề trình bày [1], [5] luận án áp dụng, với tên gọi dự báo đầu thơng qua tuyến tính hóa đoạn mơ hình phi tuyến dọc theo trục thời gian
Sau đây, luận án giới hạn việc trình bày tư tưởng giải pháp cho hệ song tuyến, lớp hệ có cấu trúc phi tuyến đơn giản, giống mơ hình tốn mơ tả chuyển động tàu thủy ba bậc tự mặt phẳng ngang
Hệ song tuyến hệ phi tuyến có cấu trúc gần với tuyến tính Mơ hình trạng thái hệ song tuyến có dạng chung là:
Mơ hình dạng liên tục: ( ) ( ) ( )
x A x x B x u y C x x
(2.19)
với ma trận ( ), ( ), ( )A x B x C x phụ thuộc trạng thái x
hoặc dạng rời rạc:
1 ( ) ( )
( )
k k k k k
k k k
x A x x B x u
y C x x
(2.20)
trong đó, khác với hệ tuyến tính (2.12), ma trận hệ thống A x , ( )( k) B xk , (C xk) lúc phụ thuộc trạng thái
Thuật toán điều khiển dự báo cho hệ song tuyến (2.20) sở dự báo tín hiệu nhờ mơ hình tuyến tính hóa đoạn trục thời gian trình bày [1], [5] Tiếp theo, luận án mở rộng thuật tốn thêm chút cho lớp hệ song tuyến có ma trận hệ thống khơng phụ thuộc trạng thái x , mà k
còn phụ thuộc tín hiệu đầu vào khứ uk1 sau:
1 1
1
( , ) ( , )
( , )
k k k k k k k
k k k k
x A x u x B x u u
y C x u x
(57)Từ mơ hình song tuyến mở rộng (2.21) này, đặt biến
1 1
1 1 ( , ) ( , ) ( , ) , ( ) , ( ) ( ) ( , ) , ,
k k k k k k k
k k k
k
k k k k k k
x A x u B x u B x u
z A z B z
u I I
C z C x u u u u
0
(2.22)
nó chuyển thành hệ song tuyến có chứa thành phần tích phân (2.23)
1 ( ) ( )
( )
k k k k k
k k k
z A z z B z u
y C z z
(2.23)
Với mô hình (2.23) có chứa thành phần tích phân nêu trên, trước tiên, nghiên cứu sinh tìm cách xác định đầu dự báo yk i , i 1, 2, ,N cho hệ mà tránh phải sử dụng tới phép tính hàm hợp cho cơng thức (2.18), tức không sử dụng tới:
1 1 1 1
1
( )
( ) ( ) ( ) ( )
( , , , , ) k i k i
k i
k i k i k i k i k i k i k i k i
i k k k k i
y C z z
C A z z B z u A A z z B z u
h x u u u
Để làm điều này, theo [1], [5] thời điểm k tại, véc-tơ trạng thái z biết, nên mơ hình song tuyến (2.23), khoảng thời gian nhỏ k
a a
kT t kT với T chu kỳ trích mẫu a khoảng thời gian thực vòng lặp, xấp xỉ mơ hình tuyến tính tham số LTI, ký hiệu mơ hình k:
1
: k k k k k
k
k k k
z A z B u
y C z
với Ak A z( k), Bk B z( k), Ck C z( k) (2.24)
(58)khiển dự báo thu uk i , i0,1, ,N 1 có giá trị u ứng với k
i thực sử dụng vào việc điều khiển đối tượng
Quay lại việc thiết kế điều khiển dự báo cho hệ (2.24) Do hệ LTI với mơ hình đối tượng giống (2.13), (2.14) nên kết áp dụng cho hệ (2.24) Nói cách khác, giá trị tín hiệu điều khiển dự báo cho hệ song tuyến (2.21) là:
1 ,0, ,0
T T
k k k k k k
k k k k
u u I H Q H R H Q b w (2.25)
trong đó: 2 , k k k k
k k k k k k k
k k k
N N N
k k k k k k k k k k
C A C B
C A B C B C A
H z
C A B C A B C B C A
0 0 0
b (2.26)
mơ hình tuyến tính hóa đoạn dọc trục thời gian thể Hình 2.3
( )k
k z z t
Tính ˆ( )
ˆ ( ) ˆ ( ) k k k A z B z C z A B C Đo
: k k k
k
k k
z u
z
z A B
y C
Mơ hình LTI xấp xỉ
1
k
t tk tk1 tk2
1 ( ),
k u t tk t tk
1
( ), k k
u t t t t
t
a
kT
Hình 2.3 Tuyến tính hóa đoạn mơ hình song tuyến dọc trục thời gian
Điểm khác biệt điều khiển (2.25) cho hệ song tuyến (2.21) điều khiển (2.17) cho hệ tuyến tính (2.12) ma trận A B C k, k, k cho hệ song tuyến, tính theo (2.22), (2.24), phải xác định lại theo vòng lặp, tức ma trận H cho công thức (2.26) thay đổi theo k , khơng cịn k
(59)2.1.4 Một số giải pháp nâng cao chất lƣợng điều khiển dự báo
2.1.4.1 Nâng cao tốc độ hội tụ sai lệch bám nhờ hiệu chỉnh tín hiệu đặt theo nguyên lý học lặp (Iterative Learning)
Trong phương pháp điều khiển thông minh dựa nguyên tắc học lặp (Iterative Learning Control - ILC), tín hiệu điều khiển lần thử thứ k , ký hiệu
( )
k
u t thường hiệu chỉnh từ thân uk1( )t sai lệch bám 1( ) 1( ) 1( )
k k k
e t y t w t lần thử thứ k1 trước đó, sau [9], [12]:
1
( ) ( ) ( )
k k k
u t u t Ke t (2.27)
có K số dương chọn thích hợp tùy theo hệ, chẳng hạn hệ tuyến tính (2.12) chọn thỏa mãn [43]:
1
I CBK (2.28)
Tư tưởng hiệu chỉnh tín hiệu điều khiển theo nguyên tắc học lặp tài liệu [5] áp dụng cho việc nâng cao tốc độ bám điều khiển dự báo hệ tuyến tính (2.12) nói riêng song tuyến (2.20) nói chung Định hướng áp dụng [5] dựa hai nhận xét sau:
Thứ điều khiển dự báo khơng có vịng thử (trials), nên việc hiệu chỉnh thực sau vòng lặp điều khiển dự báo (thay cho vòng thử ILC - trial)
Thứ hai điều khiển học lặp, công thức hiệu chỉnh (2.27) thay đổi trực tiếp tín hiệu điều khiển nên điều làm chất dự báo điều khiển dự báo Bởi vậy, hiệu chỉnh gián tiếp thơng qua tín hiệu đặt
( )
w t
Trên sở hai nhận xét đó, tài liệu [5] đưa cơng thức hiệu chỉnh tín hiệu đặt r dựa sai lệch k /
1 1
k k k
e y w vòng lặp trước đó, thay cho tín hiệu đặt gốc ban đầu w , sau: k
1
k k k
(60)/
1 1
k k k
e y w (2.30)
với /
k
y đầu đo hệ vịng lặp trước Nghiên cứu sinh ký hiệu /
1
k
y để phân biệt với đầu dự báo yk i vốn suy từ mơ hình Ở vịng lặp đầu tiên, gán e0 0, tức vịng lặp có rk wk
Với cơng thức hiệu chỉnh tín hiệu đặt (2.29), véc-tơ w tính theo (2.6), k
dùng điều khiển (2.17) (2.25), thay r xác k
định sau:
1
k k
k
k N k
w Ke w Ke
r với ek yk/ wk (2.31)
Hình 2.4 minh họa nguyên tắc hiệu chỉnh tín hiệu đặt cho trường hợp đơn giản tín hiệu đặt ban đầu số (wk w constant)
Hình 2.4 Ý nghĩa hiệu chỉnh tín hiệu đặt cho điều khiển dự báo [5]
2.1.4.2 Lọc nhiễu chuyển phản hồi trạng thái thành phản hồi đầu nhờ quan sát Kalman
Một vấn đề thường gặp ứng dụng thực tế ảnh hưởng nhiễu vào hệ thống Nếu cần phải để ý tới ảnh hưởng loại nhiễu trình thiết kế điều khiển, mơ hình gốc ban đầu hệ song tuyến (2.21) có thêm nhiễu đo là:
1 1
1
( , ) ( , )
( , )
k k k k k k k k
k k k k
k
x A x u x B x u u
y C x u x
(2.32) e k r k r e w ( ) y t t
a) Khơng hiệu chỉnh tín hiệu đặt k k 1 k2
w
( )
y t
t
(61)trong k, k nhiễu tác động tới trạng thái nhiễu tác động đầu hệ Tương tự làm chuyển đổi (2.21) thành (2.23), mơ hình (2.32) viết lại thành:
1 ( ) ( )
( )
k k k k k k
k k k
k
z A z z B z u
y C z z
(2.33)
với k col(k, 0), zk col(x uk, k1), uk uk uk1 A z( k), (B zk), (C zk) xác định từ A x u( k, k1), (B x uk, k1), (C x uk, k1) theo công thức (2.22)
Giả sử thời điểm k1 ta có giá trị trạng thái zk1 khơng lẫn nhiễu nhiệm vụ lọc nhiễu phải xác định tiếp z có đầu vào k uk1 đầu y k Để thực nhiệm vụ đó, trước tiên ta xấp xỉ mơ hình khơng có nhiễu từ (2.33) thành:
1 1
1
k k
k k k
k k k
z z u
y z
với k1A z( k1), k1B z( k1), k1C z( k1) (2.34)
sau đó, tìm zk, k 1, 2, nhờ lọc Kalman sau [4], [5], [31]:
1 1
1
1 1
1 /
1 1
/ /
1
T
k k k k X
T T
k k k k k k
k k k k
k k
k k k
k k
k k k k
P K N
L P P V
K I L P
z z u
z z L y z
(2.35)
trong N V ma trận tương quan X, k k, cịn K tùy 0 chọn
Sau có z thay k z , tốn khơng bị ràng buộc, k
(62)
1 ,0, ,0
T T
k k k k k k
k k k k
u u I Q R Q b r (2.36)
với r xác định theo (2.31) k
2 , ( ), ( ), ( ) k k k k
k k k k k k k
k k k
N N N
k k k k k k k k k k
k k k k k k
z
A z B z C z
0 0 0 b (2.37)
2.2 Các phƣơng pháp tối ƣu hóa có ràng buộc
Trong điều khiển dự báo có thành phần tối ưu hóa Hình 2.1a với nhiệm vụ tìm nghiệm p toán tối ưu (2.8) thỏa mãn ràng buộc P Nó thực * vịng lặp Một cách tổng qt tốn có dạng chung cho tất vịng lặp là:
* arg ( )
p P
p J p
với P pRn i( )p 0, i 1, 2, ,m (2.38)
trong i( )p – hàm mơ tả điều kiện ràng buộc
2.2.1 Những phƣơng pháp tối ƣu hóa có ràng buộc thƣờng sử dụng
Để giải tốn tối ưu hóa có ràng buộc thơng thường sử dụng hai phương pháp phương pháp tối ưu truyền thống phương pháp tối ưu tiến hóa
2.2.1.1 Phƣơng pháp tối ƣu hóa truyền thống
(63)fmincon() với options chuẩn MatLab „sqp‟ fmincon() với options chuẩn MatLab „interior-point‟
2.2.1.2 Phƣơng pháp tối ƣu tiến hóa
Các phương pháp tối ưu tiến hóa (evolutional optimization) cho tốn tối ưu có ràng buộc (2.38) xây dựng sở lặp bước, giống line search, song quy luật tìm kiếm chép từ phản ứng tự nhiên sinh/động vật, thay xác định hướng tìm khoảng cách bước tìm tốn học Có nhiều phiên tối ưu tiến hóa khác nhau, nói, chúng có gốc gác từ hai phương pháp giải thuật di truyền (Genetic Algorithm - GA) tối ưu bày đàn (Particle Swarm Optimization - PSO) Nội dung chi tiết phương pháp trình bày tài liệu [12], [37], [42] Hiện nay, thuật toán „GA‟ „PSO‟ cài đặt chuẩn thành lệnh ga() particleswarm() MatLab 2.2.2 Giải pháp điều khiển tối ƣu hóa có ràng buộc với điều khiển MPC
Các phương pháp giải tốn tối ưu hóa có ràng buộc đề cập sử dụng thuận tiện phương pháp cụ thể hóa lệnh Matlab Tuy nhiên, điều khiển theo nguyên lý receding horizon MPC vịng lặp điều khiển phải giải toán tối ưu lần, điều dẫn tới thời gian tính tốn lệnh tối ưu hóa có ràng buộc vượt khoảng thời gian cho phép thực vòng lặp tức khoảng thời gian tk1tk Bởi vậy, để đơn giản sau luận án sử dụng kỹ thuật ước lượng xấp xỉ giới thiệu [2], [5] để giải tốn tối ưu có ràng buộc Kỹ thuật xây dựng dựa nhận xét tín hiệu điều khiển u (2.25) thay đổi theo k
vòng lặp với k 0,1, phụ thuộc vào việc chọn ma trận xác định dương R Q k, k
như sau:
Nếu ma trận Q đối xứng xác định dương chọn có chuẩn k Q lớn, k sai số bám nhỏ gián tiếp kéo theo nghiệm tối ưu ( )u t có ( )u t
(64)Ngược lại, ma trận R đối xứng xác định dương chọn có chuẩn k R k
càng lớn, nghiệm tối ưu ( )u t tìm có ( )u t nhỏ, gián tiếp kéo theo
sai lệch bám lớn hệ hội tụ chậm
Do trường hợp tín hiệu điều khiển ( )u t bị ràng buộc, chẳng hạn như:
( )
a u t b (2.39)
thì hiệu chỉnh giá trị R Q thích hợp theo vòng lặp để điều kiện (2.39) k, k thỏa mãn Giải pháp luận án áp dụng để giải điều kiện ràng buộc tín hiệu điều khiển luận án đặt
2.3 Thiết kế điều khiển MPC điều khiển chuyển động tàu bám quỹ đạo đặt, có ràng buộc tín hiệu điều khiển mơ hình tàu xác định
Như đề cập chương luận án, mơ hình xác định tàu thủy ba bậc tự thiếu cấu chấp hành mơ hình có cấu trúc xác định, tham số mơ hình xác định mơ hình coi khơng có nhiễu tác động Mục tiêu nhiệm vụ luận án từ mơ hình xác định, thiết kế điều khiển chuyển động tàu thủy bám theo quỹ đạo đặt có ràng buộc tín hiệu điều khiển
Mơ hình động lực học tàu thủy ba bậc tự do, thiếu cấu chấp hành mặt phẳng ngang dạng mơ hình xác định (khơng chứa thành phần bất định) theo [21] có cấu trúc sau:
3
2
( ) , ,
( ) ( ) ( ) , ,
J
M C D g F F
R R
R R
(2.40)
trong F ma trận có số cột số hàng (đặc điểm hệ thiếu cấu chấp hành) Nhiệm vụ điều khiển xây dựng điều khiển để đầu hệ bám theo quỹ đạo mẫu d( )t w t( ) cho trước, đồng thời thỏa mãn điều kiện ràng buộc a b Đối với độ lớn góc bẻ lái tàu thủy qui định,
gh gh
, với góc bẻ lái, gh giới hạn góc bẻ lái Điều kiện ràng buộc tương đương với ràng buộc mô-men giới hạn quay trở r sau:
r gh r r gh
(65)trong r gh. – giá trị giới hạn đặt mô-men bánh lái (giá trị tỷ lệ với độ lớn góc bẻ lái coi tương đương với ràng buộc độ lớn góc bẻ lái)
Để giải nhiệm vụ đặt ra, luận án sử dụng nguyên lý điều khiển dự báo MPC sở tuyến tính hóa đoạn mơ hình phi tuyến dọc theo trục thời gian giải pháp tối ưu hóa có ràng buộc để thiết kế điều khiển Trong giới hạn phạm vi nghiên cứu luận án, tín hiệu điều khiển thiết kế lực (lực đẩy chân vịt) mô-men (mô-men bánh lái), chúng ký hiệu mơ hình (2.40) khơng quan tâm tới mơ hình tốn cấu thực hiện, cơng trình nghiên cứu điều khiển tàu có mơ hình tốn dạng thiếu cấu chấp hành, khơng xét đến mơ hình cấu chấp hành
2.3.1 Thiết kế điều khiển dự báo phản hồi trạng thái điều khiển tàu chuyển động bám quỹ đạo đặt mơ hình tàu xác định
Ta thấy mơ hình tàu thủy ba bậc tự mặt phẳng ngang (2.40), trường hợp xấp xỉ được:
( ) ( )
g G (2.42)
với 3
( )
G R ma trận phụ thuộc , hệ song tuyến Vì để đồng với phần lý thuyết trình bày trên, sau luận án viết lại mô hình tốn tàu thủy ba bậc tự mặt phẳng ngang (2.40) dạng song tuyến tắc cho công thức (2.19) (2.21) sau:
Từ (2.40) (2.42) có được:
3 3
1
( )
( ) ( ) ( )
J
G M C D M F
0 0 (2.43)
trong 03 3 ma trận khơng kiểu 3 (3 hàng cột) Do đó, đặt biến x1, x2 , u x col( ,x x1 2), ký hiệu:
3 3
3 3
1
1 2
( )
( ) , , ,
( ) ( ) ( )
J x
A x B C I
G x M C x D x M F
0 0 0 (2.44)
(66) 3 3 3
( ) ,
x A x x Bu
y I x C x
0 (2.45)
trong I ký hiệu ma trận đơn vị kiểu 33 Như vậy, (2.45) hệ song tuyến so sánh với hệ song tuyến nói chung, mơ tả cơng thức tổng qt (2.19), cịn gần với hệ tuyến tính chỗ hai ma trận B C mơ , hình (2.45) số Do đó, phương pháp điều khiển dự báo cho hệ song tuyến trình bày mục 2.1.3 hồn tồn áp dụng để tín hiệu đầu y
của mơ hình tàu thủy ba bậc tự mặt phẳng ngang dạng song tuyến (2.45) bám tiệm cận theo quỹ đạo mẫu ( )w t cho trước
Để thiết kế điều khiển dự báo phản hồi trạng thái cho mô hình (2.45) biến trạng thái x col( ,x x1 2), x1, x2 giả thiết phải đo đạc xác định trực tiếp
2.3.1.1 Mô hình dự báo sở tuyến tính hóa đoạn mơ hình dọc trục thời gian
Do việc thiết kế điều khiển dự báo cần tới mơ hình khơng liên tục (mơ hình rời rạc theo thời gian) nên ta rời rạc mơ hình tàu thủy ba bậc tự mặt phẳng ngang dạng liên tục (2.45) với chu kỳ trích mẫu T chọn trước a
Sử dụng công thức xấp xỉ: x t( )x k( 1)Tax kT( a) Ta cho phép tính đạo hàm, mơ hình liên tục (2.45) chuyển dạng rời rạc (2.46):
1 a ( ) a
k k k k
k k
x I T A x x T Bu
y C x
(2.46)
trong đó: xk x kT( a), uk u kT( a), yk y kT( a), I ma trận đơn vị kiểu 66 Tiếp theo, ta xét thời điểm k Nếu véc-tơ trạng thái x k
là biết, đo trực tiếp từ hệ thống, quan sát từ liệu vào/ra đo uk1, yk, khoảng thời gian đủ nhỏ, mơ hình song tuyến (2.46) xấp xỉ mô hình tuyến tính tham số
(67)1
: k k k k
k
k k
z A z B u
y C z
(2.47) đó:
1
col , ,
k k k k k k
z x u R u u u R (2.48)
6 8 8
3
2 2
( )
, , ,
a k a a
k
I T A x T B T B
A B C C
I I
0 R R 0 R (2.49)
Từ mơ hình xấp xỉ tuyến tính đoạn k với k 0,1, cho (2.47), ta có cơng thức dự báo xấp xỉ cho tín hiệu đầu yk i , i 1, 2, ,N hệ (2.46) thuộc cửa sổ dự báo [ , )k N , sau:
1
1
i i i
k i k k k k k i
y CA z CA B u CA B u CB u ,
trong N 2 độ rộng cửa sổ dự báo chọn trước Viết chung đầu tương lai lại với theo cấu trúc véc-tơ cho toàn cửa số dự báo, có:
1 3
2
3
2
1
1
k
k k
k k k
k
k k
N N N
k N
k k
k N k
k k
y CB u CA
y CA B CB u CA
z
u
y CA B CA B CB CA
H p 0 0 0 y b (2.50) với:
3
2
3
1
1
, ,
k k
k k k
k k k
N N N
k N
k k k
CA
CB u
CA B CB u CA
H p z
u
CA B CA B CB CA
0 0 0
b (2.51)
trong p véc-tơ tín hiệu đầu vào tương lai cần phải xác định 2.3.1.2 Xây dựng khối hàm mục tiêu điều khiển MPC
(68), 0,1, , k j
u j N
cho cơng thức (2.50) để xác định đầu vào tương lai cho đầu bám theo dãy tín hiệu đặt { }wk Ta cần khối hàm mục tiêu thể mục đích bám tín hiệu đặt hàm mục tiêu thể điều tổng bình phương sai lệch bám thuộc sổ dự báo
Tuy nhiên, nhằm nâng cao tốc độ bám, luận án sử dụng kỹ thuật hiệu chỉnh tín hiệu đặt nói tới mục 2.1.4.1 chương 2, mà cụ thể tín hiệu đặt sau hiệu chỉnh r cho công thức (2.31) với: k
1
k k
k
k N k
w Ke w Ke
r có wk w kT( a), (2.52)
trong /
k k k
e y w sai lệch bám dư thừa thời điểm trước 0K 1 tham số tùy chọn
Hàm mục tiêu thể sai lệch bám nhỏ véc-tơ tín hiệu đầu tương lai y cho cơng thức (2.50) véc-tơ tín hiệu đặt sau hiệu chỉnh k
cho công thức (2.52) là:
( ) T T
k k k k k k k
p
J p y r Q y r p R p (2.53)
trong 3 2 ,
N N N N
k k
Q R R R hai ma trận đối xứng xác định dương tùy chọn
Cuối cùng, loại bỏ bớt thành phần số không phụ thuộc biến p cần tìm hàm mục tiêu (2.53) trên, ta có hàm mục tiêu tương đương, với cấu trúc đơn giản hơn, sau:
/
( ) T T T
k k k k k k k k k
p
J p p H Q H R p b r Q H p (2.54)
2.3.1.3 Xây dựng khối tối ƣu hóa điều khiển
(69)/ * arg k( )
p P
p J p
(2.55)
có tập ràng buộc P suy từ điều kiện ràng buộc (2.41) qui định giới hạn độ lớn góc bẻ lái tàu thủy Giải pháp để tìm nghiệm tốn tối ưu có ràng buộc sử dụng kỹ thuật ước lượng xấp xỉ điều kiện ràng buộc thông qua thay đổi tham số hàm mục tiêu, trình bày mục 2.2.2 chương
Một cách cụ thể, toán điều khiển khơng có ràng buộc, nghiệm p * tốn tối ưu (2.55) có hàm mục tiêu cho (2.54) là:
* Tk k k k Tk k k k
p H Q H R H Q b r (2.56)
Khi có p ta có tín hiệu điều khiển * u cho hệ điều khiển chuyển k động tàu thủy (2.40) thời điểm k , suy từ công thức (2.48), sau:
2 2 2( 1) *
1 , N
k k
u u I 0 p (2.57)
và đưa vào để điều khiển phạm vi khoảng thời gian trích mẫu a
T
Nếu tốn có điều kiện ràng buộc cho u từ (2.57) ta thấy điều kiện ràng k
buộc chuyển sang điều kiện ràng buộc cho p Do điều kiện ràng buộc tín * hiệu điều khiển với đối tượng tàu thủy luận án ràng buộc dạng khoảng cụ thể gh uk gh (suy từ ràng buộc độ lớn góc bẻ lái), nên ta thay đổi Q R để k, k p thỏa mãn điều kiện ràng buộc Chi tiết hơn, * công thức (2.56) cho thấy R lớn k p nhỏ, ngược lại * Q lớn k
*
p lớn
2.3.1.4 Thuật toán điều khiển dự báo phản hồi trạng thái
Hình 2.5 biểu diễn thuật tốn bước tính cần thực vòng lặp thời điểm k để xác định tín hiệu điều khiển u minh họa cấu trúc k
(70)Tùy chọn:
0, 0,
T T
Q Q R R
Bắt đầu
2,
N
Ma trận xác định dương Cửa sổ dự báo
Hệ số hiệu chỉnh giá trị ràng buộc 1,ugh thời gian trích mẫuTa
Gán:
Tính ,B C theo (2.44) B C, theo (2.49)
Giá trị khởi tạok0,u10,e00,A0 ,x0
( , )
k
x col
Đo:
Tính: A theo (2.49).k Và Hk,b r theo (2.51), (2.52)k, k
Tìm:
*
p theo (2.56), sau tính
k gh
u u
đúng
Gán:
RR
sai
đúng
k
u theo (2.57)
k
u
Đƣa: vào điều khiển đối tượng liên tục (2.40), hay (2.45)
Gán:
0
x x
0
u u
0
A A
Hệ số hiệu chỉnh tín hiệu đặt 0K 1
sai
Trạng thái từ đối tượng điều khiển (2.40)
Nghiệm tối ưu
đúng sai
Kết thúc
Ràng buộc tín hiệu điều khiển =
:
k k
Lệnh dừng điều khiển =1
?
?
?
(71)a T
(k1)Ta
a kT
a
kT t
Tính uk1
Thuật tốn xác định tín hiệu điều khiển uk
k u
b Minh họa thuật toán điều khiển MPC-S trượt dọc trục thời gian
Hình 2.5 Thuật toán điều khiển dự báo phản hồi trạng thái (MPC-S), điều khiển chuyển động tàu thủy bám quỹ đạo đặt
Khoảng thời gian chênh lệch đo trạng thái x có k u k khoảng thời gian cần thiết để thực tất phép tính, bao gồm xác định
*
, , , , k k k k
A H b r p cuối u Về nguyên tắc, với tốc độ tính tốn k thiết bị số nhỏ bỏ qua
Khi có u , đưa vào điều khiển hệ (2.40), hệ liên tục k (2.45), khoảng thời gian trích mẫu T , từ thời điểm a kTa tới thời điểm (k1)Ta Ở thời điểm (k1)Ta vịng tính tốn lặp thực lại, bắt đầu việc đo trạng thái xk1, tính tốn Ak1,Hk1,bk1,rk1,p* để lại
có uk1 cho chu kỳ trích mẫu
Như vậy, hệ điều khiển vịng kín, bao gồm đối tượng điều khiển hệ liên tục (2.40) điều khiển số (bộ điều khiển dự báo) hệ sampled data
Thuật toán điều khiển dự báo phản hồi trạng thái luận án ký hiệu MPC-S, ký tự S thêm vào để ngụ ý thuật toán điều khiển phản hồi trạng thái (system states)
2.3.1.5 Mô điều khiển MPC-S a Đối tƣợng quỹ đạo mô
(72)thuật tàu sử dụng mô lấy từ tài liệu [21] tác giả Do K D and J Pan (2009) Số liệu chi tiết thơng số tàu, tham số mơ hình tốn cho bảng PL.1 phụ lục Số liệu thông số tàu nhiều tác giả sử dụng để mô phỏng, kiểm chứng điều khiển nghiên cứu mơ hình tàu thiếu cấu chấp hành cơng trình: [14], [16] - [21], [48] [64])
Để kiểm tra chất lượng bám quỹ đạo điều khiển đề xuất, luận án đưa hai quỹ đạo đặt thường hay áp dụng với tàu biển q trình chạy kiểm tra đặc tính điều động quay trở tàu sau:
Quỹ đạo 1: tàu chạy theo quỹ đạo đường thẳng, sau tàu chạy lượn vịng trịn
với bán kính lượn vịng 200(m), luận án gọi quỹ đạo hình trịn, Hình 2.6a
Quỹ đạo 2: tàu chạy theo đường thẳng, sau chạy quỹ đạo zíc-zắc hình sin
với biên độ 175m, sau chạy tiếp với quỹ đạo thẳng, luận án gọi quỹ đạo hình sin, Hình 2.6b
a) Quỹ đạo đặt hình trịn với bán kính 200(m)
b) Quỹ đạo đặt hình sin với biên độ hình sin 175(m)
Hình 2.6 Quỹ đạo đặt kiểm chứng chất lượng điều khiển
Ký hiệu đại lượng mô sau: [ d, d, d]
d x y
(73)ex xd x e, y yd y e, hd d – sai lệch bám quỹ đạo theo trục x , y sai lệch bám hướng
Thời gian mô tính giây [s], tọa độ quỹ đạo mặt phẳng ngang tàu hệ trục tọa độ trái đất xoy theo đơn vị dài [m], hướng tàu theo đơn vị độ [deg], hướng độ trùng với hướng Bắc thật Trái Đất Đơn vị lực tác động [N], mô-men [N.m], vận tốc dài [m/s], vận tốc góc [rad/s]
b Kết mơ
Chương trình điều khiển viết theo thuật toán điều khiển MPC-S, với tham số cài đặt sau:
Cửa sổ dự báo: N 2 (cài đặt N 5)
Thời gian trượt (receding horizon) Ta 0.1( )s
Tham số hiệu chỉnh tín hiệu đặt 0K1 (cài đặt K 0.2) Tín hiệu điều khiển ban đầu thời điểm t1 (u10)
Ma trận xác định dương ,Q R (đặt Q diag ([50;50;100]); R diag ([1;1])) Cài đặt ràng buộc tín hiệu điều khiển (giả thiết giá trị ràng buộc đặt
5
8.10 ( )
r gh N m
) tín hiệu điều khiển mơ-men quay trở phải thỏa mãn:
r gh r r gh
Giá trị ban đầu quỹ đạo đặt quỹ đạo vị trí tàu: Quỹ đạo hình trịn: xd(0)0,yd(0)50,d(0)0,
x(0)0, (0)y 30, (0) 0, (0)u 4, (0)v 2.3, (0)r 0.1 Quỹ đạo hình sin: xd(0)5,yd(0)30,d(0)0
(74)Kết mô điều khiển MPC-S với quỹ đạo hình trịn
a) Kết mô quỹ đạo chuyển động – quỹ đạo hình trịn (MPC-S)
b) Sai lệch bám quỹ đạo – quỹ đạo hình trịn (MPC-S)
c) Sai lệch bám hướng – quỹ đạo hình trịn (MPC-S)
(75)e) Tín hiệu điều khiển mô-men quay trở r không ràng buộc – quỹ đạo hình trịn (MPC-S)
f) Tín hiệu điều khiển mơ-men quay trở r, có ràng buộc với giả thiết giá trị
ràng buộc 5
8.10 ( )N m r 8.10 ( )N m
– quỹ đạo hình trịn (MPC-S)
Hình 2.7 Kết mơ phỏng, kiểm chứng chất lượng điều khiển MPC-S với quỹ đạo hình trịn
Kết mơ điều khiển MPC-S với quỹ đạo hình sin
(76)b) Sai lệch bám quỹ đạo – quỹ đạo hình sin (MPC-S)
c) Sai lệch bám hướng – quỹ đạo hình sin (MPC-S)
d) Tín hiệu điều khiển lực trượt dọc u – quỹ đạo hình sin (MPC-S)
(77)f) Tín hiệu điều khiển mơ-men quay trở r, có ràng buộc với giả thiết giá trị
ràng buộc 5
8.10 ( )N m r 8.10 ( )N m
– quỹ đạo hình sin (MPC-S)
Hình 2.8 Kết mơ phỏng, kiểm chứng chất lượng điều khiển MPC–S với quỹ đạo hình sin
Nhận xét:
Kết mô điều khiển MPC-S cho thấy thử nghiệm với hai quỹ đạo đặt quỹ đạo hình trịn, quỹ đạo hình sin cho tín hiệu quỹ đạo đầu bám theo quỹ đạo đặt với chất lượng tốt tín hiệu điều khiển u2r có ràng buộc (ràng buộc giá trị mô-men tương đương với điều kiện ràng buộc góc bẻ lái)
Sai lệch bám quỹ đạo ,e e , sai lệch bám hướng x y e có giá trị nhỏ so với quỹ hd
đạo chuyển động tàu Sai lệch bám quỹ đạo lớn khoảng 8m với quỹ đạo hình trịn, khoảng 5.5m với quỹ đạo hình sin Sai lệch bám quỹ đạo, bám hướng có xu hướng tăng điểm quỹ đạo tàu bắt đầu chuyển động vào quỹ đạo đường tròn điểm quỹ đạo vào, với quỹ đạo hình sin điểm mà tọa độ quỹ đạo thay đổi nhiều Sai lệch bám quỹ đạo hướng thời điểm ban đầu phụ thuộc nhiều vào việc cài đặt tọa độ vị trí hướng ban đầu tàu (0), (0), (0)x y
(78)Chất lượng điều khiển dự báo MPC-S phụ thuộc vào việc chọn giá trị ma trận xác định dương ,Q R cửa sổ dự báo N Nếu cửa sổ dự báo
chọn lớn sai lệch bám nhỏ kéo theo khoảng tính tốn (thời gian trượt) tăng Việc chọn ma trận xác định dương ,Q R ảnh hưởng tới độ lớn
của tín hiệu điều khiển (như phân tích mục 2.2.2)
Bộ điều khiển MPC-S có hạn chế tất biến trạng thái đối tượng bao gồm x1,x2 u v rTphải đo đạc xác định trực tiếp Thực tế với tàu thủy trạng thái x1 hồn tồn xác định nhờ GPS la bàn điện tàu Hiện việc xác định trạng thái x2 u v rTcũng xác định DGPS (Differential Global Positioning Systems), việc áp dụng hạn chế Do để giải hạn chế đó, luận án tiến hành xây dựng quan sát trạng thái x2 u v rTtừ tín hiệu đầu x1 thiết kế điều khiển dự báo phản hồi đầu
2.3.2 Thiết kế điều khiển dự báo phản hồi đầu theo nguyên lý tách để điều khiển chuyển động tàu bám quỹ đạo đặt mơ hình tàu xác định
Bộ điều khiển phản hồi đầu theo nguyên lý tách ghép nối điều khiển phản hồi trạng thái MPC-S quan sát trạng thái mô tả Hình 2.9
Bộ điều khiển
dự báo MPC-S ZOH Tàu thủy
Quan sát trạng thái
{wk}
k
x
( )t
( ) y t ( )
u t
( )t
k u
Hình 2.9 Cấu trúc điều khiển phản hồi đầu theo nguyên lý tách, điều khiển chuyển động tàu thủy bám quỹ đạo đặt
(79)cho hệ phi tuyến,… Định hướng luận án xây dựng quan sát trạng thái cho đối tượng tàu thủy với giả thiết khơng có nhiễu đo Cịn giá trị đo từ hệ thống, tín hiệu vào ra, bị lẫn nhiễu đo ký hiệu
( )t
nhiễu hệ thống ký hiệu ( ) t Hình 2.9 quan sát trạng thái thích hợp có thêm chức lọc nhiễu sử dụng quan sát Kalman mở rộng (EKF) Những hệ lẫn nhiễu gọi hệ ngẫu nhiên
2.3.2.1 Xây dựng quan sát trực tiếp trạng thái từ mô hình liên tục
Phương pháp quan sát trực tiếp (QSTT) xây dựng trực tiếp từ mơ hình liên tục (2.40), dạng tương đương (2.43) (2.45), mơ hình tàu thủy ba bậc tự mặt phẳng ngang, sở giả thiết phép đo tín hiệu đầu
( ) ( )
y t t xác (thực tế tín hiệu ( ) t gồm tọa độ vị trí hướng tàu hệ tọa độ trái đất hoàn toàn xác định xác thơng qua thiết bị định vị GPS (Global Positioning System) la bàn (Gyrocompass) điện gắn tàu) Nhiệm vụ từ xác định véc-tơ trạng thái
col( , )
x hệ liên tục tương ứng (2.43) hay (2.45)
Trong hai thành phần ( ), ( ) t t véc-tơ trạng thái x t( )col( ) , ( )t t , có đầu ( )y t ( )t , nên đo tín hiệu đầu ( )y t cách xác, ta có thành phần thứ ( ) t Bởi nhiệm vụ quan sát lúc xác định thành phần thứ hai ( ) t
Từ quan hệ hai thành phần trạng thái ( ), ( ) t t cho mơ hình (2.40) là: ( )
J
có ( ) t y t( ) ma trận ( )J trực giao (đặc điểm mơ hình tàu thủy ba bậc tự mặt phẳng ngang), nên có thành phần trạng thái ( )t cịn lại thơng qua:
( )t J( )T J y y( )T
nếu có giá trị đạo hàm ( )y t tín hiệu đầu ( )y t Để làm điều
(80)( ) T s D s Ts
với số T 0 nhỏ tùy chọn, (2.58)
có đầu vào ( )y t Do có T 0 nên đầu nó, ký hiệu ( )y t là:
y Ty y hay y y J ( )
Cuối cùng, ghép chung ( ) t y t( ) đo từ đầu và: ( )t J( )T J y y J y y( )T ( )T
với ( )y t đầu khâu DT1 cho (2.58) có đầu vào ( )y t ta có đầy
đủ véc-tơ trạng thái x t( )coly t( ) , ( )J y yT mơ hình tàu thủy ba bậc tự Hình 2.10 mơ tả cấu trúc quan sát trạng thái trực tiếp từ mơ hình liên tục
( ) ( )
( )T y t x t
J y y
J y y( )T D sT( )
Tàu thủy
( )
u t y t( )( )t
( ) T s D s Ts y
( )t
Hình 2.10 Quan sát trạng thái trực tiếp từ mơ hình liên tục tàu thủy ba bậc tự
a Cài đặt mô kiểm chứng quan sát trực tiếp Các thông số cài đặt quan sát trực tiếp (QSTT) bao gồm:
Thời gian quan sát QSTT, Ta 0.01 0.1( ) s khoảng thời gian trượt (receding horizon), thời gian quan sát ngắn độ xác quan sát cao, thời gian quan sát chọn chu kỳ trích mẫu điều khiển trượt
Giá trị quan sát ban đầu (0), (0), (0)u v r quan sát, giá trị ban đầu chọn gần giá trị thực chất lượng quan sát tốt
Chất lượng quan sát đánh giá dựa sai lệch tín hiệu quan sát tín hiệu thực sau:
, ,
u v r
(81), ,u v r QSTT
b Kết mô phỏng, kiểm chứng QSTT với quỹ đạo hình trịn
a) Kết mô quan sát trạng thái tốc độ trượt dọc u – quỹ đạo hình trịn
b) Kết mô quan sát tốc độ trượt ngang v – quỹ đạo hình trịn
c) Sai lệch quan sát tốc độ trượt dọc e , trượt ngang u e – quỹ đạo hình tròn v
(82)e) Sai lệch quan sát tốc độ quay trở e – quỹ đạo hình trịn r
Hình 2.11 Đồ thị mơ kết QSTT tàu chạy quỹ đạo hình trịn
c Kết mô phỏng, kiểm chứng quan sát với quỹ đạo hình sin
a) Kết mô quan sát tốc độ trượt dọc u – quỹ đạo hình sin
(83)c) Sai lệch quan sát tốc độ trượt dọc e , trượt ngang u e – quỹ đạo hình sin v
d) Kết mô quan sát tốc độ quay trở r – quỹ đạo hình sin
e) Sai lệch quan sát tốc độ quay trở e – quỹ đạo hình sin r
Hình 2.12 Đồ thị mô kết QSTT tàu chạy quỹ đạo hình sin
d Nhận xét chất lƣợng QSTT xây dựng
(84)lượng giá trị quan sát ban đầu gần với giá trị thực hệ thời gian độ quan sát cải thiện nhiều
Ngoài sai lệch quan sát phụ thuộc vào thời gian thực phép tính đạo hàm khâu DT1, ký hiệu T (2.58), thời gian nhỏ chất lượng quan sát tốt Mặc dù QSTT sử dụng khâu DT1 khâu có trễ song tín hiệu quan sát bám tốt tín hiệu thực, lý tàu thủy đối tượng có qn tính thơng số biến đổi chậm Do QSTT sử dụng để quan sát trạng thái thiết kế điều khiển dự báo MPC phản hồi đầu với giả thiết khơng có nhiễu đo, ảnh hưởng nhiễu đo nhỏ Trong trường hợp tín hiệu trạng thái có lẫn nhiễu đo quan sát Kalman mở rộng EKF sử dụng 2.3.2.2 Xây dựng quan sát trạng thái lọc nhiễu nhờ lọc Kalman mở
rộng (EKF)
Trong trường hợp có lẫn nhiễu đo đầu ( )y t ( )t ( )t có nhiễu ( ) t tác động vào thành phần trạng thái x t mà ta sử dụng phương pháp ( ) quan sát trực tiếp trên, kết thu sau ( )x t
tham gia nhiễu Điều ảnh hưởng tới chất lượng điều khiển điều khiển dự báo Bởi ta cần tới quan sát khác, xác định xấp xỉ ( )x t x t( ) mà cịn có khả lọc nhiễu ( ), ( ) t t có
( )
x t Một quan sát quan sát Kalman mở rộng đề cập tới
mục 2.1.4.2 chương 2, mà sau cịn gọi quan sát gián tiếp, để phân biệt với quan sát trực tiếp mục 2.3.2.1
Bộ quan sát gián tiếp sử dụng mơ hình rời rạc (2.46), có lẫn thêm nhiễu đo k (kTa) nhiễu hệ thống k (kTa):
1 a ( ) a
k k k k k
k k k
x I T A x x T Bu
y C x
(2.59)
Nhiệm vụ quan sát thời điểm k tại, sở liệu đo hệ thống gồm đầu y đầu vào trạng thái quan sát k
(85)Thuật toán quan sát Kalman mở rộng cho hệ phi tuyến (EKF) trình bày mục 2.1.4.2, viết lại riêng cho hệ (2.59), sau:
Thuật toán EKF
1 Khởi tạo với việc xác định ma trận tương quan N X k V k Tùy chọn K 0 x (hoặc tính 0 x theo cơng thức (2.60) đây) Gán 0
1
k
2 Đo uk1, yk tính phép tính sau:
6 1
1
/
6 1
/ /
( ) ( )
( )
T
k a k k a k X
T T
k k k
k k k
a a
k k k k
k
k k k k
P I T A x K I T A x N
L P C CP C V
K I L C P
x I T A x x T Bu
x x L y C x
3 Gán :k k quay bước
Độ xác tốc độ hội tụ kết x thuật toán phụ thuộc k
nhiều vào giá trị đầu x chọn [31] Bởi vậy, để tăng tính hiệu thuật 0
toán EKF, luận án đề xuất kết hợp thêm với thuật toán quan sát trạng thái trực tiếp trình bày trên, lần bước khởi tạo để xác định x , thay tùy chọn 0
Chẳng hạn, hai thời điểm k 1 k 0 trước ta đo
1
y ,
0
y cách chu kỳ trích mẫu T giá trị trạng thái a x tính theo 0
phương pháp quan sát trực tiếp xấp xỉ bởi:
0 col 0 , ( 0) 0
T
x y J y y với
0 a y y y T
(2.60)
a Mô kiểm chứng quan sát Kalman mở rộng (EKF)
(86)Trường hợp 1: So sánh kết mô QSTT quan sát EKF với
giả thiết mơ hình (2.59) khơng có nhiễu đo
a) Kết mơ quan sát tốc độ trượt dọc u – nhiễu đo
b) Kết mơ quan sát tốc độ trượt ngang v – khơng có nhiễu đo
c) Kết mô quan sát tốc độ quay trở r – khơng có nhiễu đo Hình 2.13 Kết mơ so sánh QSTT Kalman (EKF) khơng có
nhiễu đo
Nhận xét:
(87)hơn QSTT), tín hiệu quan sát từ QSTT bám tốt tín hiệu thực, với sai lệch bám nhỏ
Trường hợp 2: So sánh kết mô QSTT quan sát EKF với
giả thiết mơ hình (2.59) có nhiễu đo ( ) t random normal(' ',0,0.05, 2*T,1)
a) Kết mô quan sát tốc độ trượt dọc u – có nhiễu đo
b) Kết mô quan sát tốc độ trượt ngang v – có nhiễu đo
c) Kết mơ quan sát tốc độ quay trở r – có nhiễu đo
Hình 2.14 Kết mơ so sánh QSTT Kalman (EKF) có nhiễu đo
(88)Như vậy, quan sát Kalman mở rộng EKF sử dụng để thiết kế điều khiển dự báo trường hợp có nhiễu đo
2.3.2.3 Thuật toán điều khiển dự báo phản hồi đầu với QSTT
Hình 2.15 mơ tả nội dung thuật tốn điều khiển dự báo phản hồi đầu theo nguyên lý tách (kết hợp điều khiển MPC-S QSTT) để điều khiển chuyển động tàu thủy bám quỹ đạo đặt Điểm khác biệt điều khiển dự báo phản hồi đầu với điều khiển dự báo phản hồi trạng thái thời điểm k ta khơng có giá trị trạng thái x hệ mà thay vào đo k
giá trị tín hiệu đầu y Bởi cần phải xác định k x từ k y sau sử dụng k
thay cho x Chính điều làm cho cơng thức tính k H b cho cơng thức k, k (2.50) phải thay Hk,b sau: k
3
2 2 , k k k
k k k
N N N
k k k
C CB
C B CB C
H z
C B C B CB C
0 0 0 b (2.61) đó:
2
( )
, col ,
a k a k
k k k k
k
I T A x T B x
z x u
I u
0 (2.62)
Tương ứng, công thức xác định hàm mục tiêu /
( ) k
J p cho (2.54) tìm
nghiệm p trường hợp tốn điều khiển khơng bị ràng buộc cho * (2.56), để phục vụ việc tính u , sửa đổi thành: k
/( ) T T 2 T min
k k k k k k k k k
p
J p p H Q H R p b r Q H p (2.63)
và:
* Tk k k k Tk k k k
p H Q H R H Q b r (2.64)
Khi có p ta có tín hiệu điều khiển * u tính theo (2.65) sau: k 2 2 2( 1) *
1 , N
k k
(89)Bắt đầu
Tính: theo (2.62).Và theo (2.52), (2.61)
Gán:
0
x x
0
u u
k rk,Hk,bk
Đo:Đầu rayk k,quan sát xk k nhờ QSTT EKF
0
Tùy chọn:
0, 0,
T T
Q Q R R
2, N
Ma trận xác định dương
Cửa sổ dự báo thời gian trích mẫuTa
Gán:
Tính ,B C theo (2.44) B C, theo (2.49)
Giá trị khởi tạok0,u10,e00,A0 ,x0
Hệ số hiệu chỉnh tín hiệu đặt 0K1
0
y
Tìm:
*
p theo (2.64), sau tính u theo (2.65)k
Nghiệm tối ưu
k gh
u u
đúng
Gán:
RR
sai
đúng
sai
k
u
Đƣa: vào điều khiển đối tượng liên tục (2.40), hay (2.45)
sai
đúng
Kết thúc
:
k k
Ràng buộc tín hiệu điều khiển =
Lệnh dừng điều khiển =1
Hệ số hiệu chỉnh giá trị ràng buộc 1,ugh
?
?
?
(90)Tương tự điều khiển phản hồi trạng thái, điều khiển dự báo phản hồi đầu luận án ký hiệu MPC-O, ký tự O thêm vào để điều khiển phản hồi đầu (Outputs)
Hình 2.16 minh họa cấu trúc điều khiển dự báo phản hồi đầu theo nguyên lý tách sử dụng phương pháp quan sát trạng thái trực tiếp Hình 2.10 Để nhấn mạnh điều khiển dự báo này, chất ghép nối thuật toán điều khiển phản hồi trạng thái (thuật toán MPC-S) quan sát trạng thái trực tiếp, nên Hình 2.16 thuật toán MPC-O dược tách thành hai khối tiêng biệt, gồm thuật toán MPC-S phản hồi trạng thái hai quan sát trạng thái trực tiếp Hình 2.10
( )T
J y y D sT( )
Tàu thủy
( )
u t y t( )( )t
y
Bộ điều khiển
dự báo MPC-S ZOH
{wk}
k
x
k
u
a T
( )
x t
Cho công thức (2.58)
( )
T D s
Hình 2.16 Cấu trúc điều khiển MPC-O với quan sát trạng thái trực tiếp
2.3.2.4 Kết mô điều khiển dự báo phản hồi đầu MPC-O a Cài đặt thuật toán điều khiển MPC-O-QSTT
Các tham số điều khiển MPC-O cài đặt sau: Cửa sổ dự báo: N 2 (cài đặt N 5)
Thời gian trượt (receding horizon) Ta 0.1( )s
Tham số hiệu chỉnh tín hiệu đặt 0K1 (cài đặt K 0.5) Tín hiệu điều khiển ban đầu u1 thời điểm t1 (đặt u10)
Ma trận xác định dương ,Q R , (đặt Q diag ([50;50;100]), R diag ([1;1])) Cài đặt ràng buộc tín hiệu điều khiển mơ-men quay trở u , giả thiết độ lớn gh
ràng buộc
1,7.10 ( )
gh r gh
(91)Giá trị ban đầu quỹ đạo đặt quỹ đạo vị trí tàu: Quỹ đạo hình trịn: xd(0)0,yd(0)50,d(0)0
(0)x 0, (0)y 50, (0) 0, (0)u 0, (0)v 0, (0)r 0 Quỹ đạo hình sin: xd(0)5,yd(0)30,d(0)0
(0)x 5, (0)y 30, (0) 0, (0)u 0, (0)v 0, (0)r 0 Giá trị quan sát trạng thái ban đầu (0), (0), (0)u v r QSTT:
Quỹ đạo hình trịn: (0) 0, (0) 0, (0) 0u v r
Quỹ đạo hình sin: (0) 0, (0) 0, (0) 0u v r
(trong , ,u v r giá trị trạng thái quan sát từ , ,u v r QSTT)
Sơ đồ mô điều khiển MPC-O đưa phần phụ lục luận án
b Kết mô đánh giá chất lƣợng Kết mô với quỹ đạo hình trịn
a) Kết mô quỹ đạo chuyển động – quỹ đạo hình trịn (MPC-O)
(92)c) Sai lệch bám hướng – quỹ đạo hình trịn (MPC-O)
d) Sai lệch bám quan sát tốc độ trượt dọc, ngang – quỹ đạo hình trịn (MPC-O)
e) Sai lệch bám quan sát tốc độ quay trở – quỹ đạo hình trịn (MPC-O)
(93)g) Tín hiệu điều khiển mơ-men r khơng ràng buộc – quỹ đạo hình trịn (MPC-O)
h) Tín hiệu điều khiển mơ-men quay trở r có ràng buộc với giả thiết giá trị ràng
buộc 5
1,7.10 ( )N m r 1,7.10 ( )N m
– quỹ đạo hình trịn (MPC-O)
Hình 2.17 Kết mô phỏng, kiểm chứng chất lượng điều khiển MPC-O-QSTT với quỹ đạo hình trịn
Nhận xét:
Kết mô điều khiển MPC-O-QSTT với quỹ đạo hình trịn cho thấy tín hiệu quỹ đạo đầu bám tốt theo quỹ đạo đặt kể tín hiệu điều khiển
2 r
u có ràng buộc với giả thiết giá trị ràng buộc là:
5
1,7.10 ( )N m r 1,7.10 ( )N m
Sai lệch bám quỹ đạo ,e e , sai lệch bám hướng x y e nhỏ Sai lệch bám quỹ hd
(94)vào khỏi quỹ đạo hình trịn, lý trạng thái x2 u v rTtrong điều khiển MPC-O-QSTT không đo đạc mà có thơng qua QSTT Số lần mơ-men quay trở thay đổi thời điểm từ 300s đến 400s từ 620s đến 720s nằm giới hạn quy định số lần bẻ lái (tương đương với số lần mô-men quay trở thay đổi) đơn vị thời gian chế độ lái tự động tàu thủy (số lần bẻ lái tối đa 350 lần/1 giờ)
Kết mơ với quỹ đạo hình sin
a) Kết mô quỹ đạo chuyển động – quỹ đạo hình sin (MPC-O)
b) Sai lệch bám quỹ đạo – quỹ đạo hình sin (MPC-O)
(95)d) Sai lệch bám quan sát tốc độ trượt dọc, ngang – quỹ đạo hình sin (MPC-O)
e) Sai lệch bám quan sát tốc độ quay trở – quỹ đạo hình sin (MPC-O)
f) Tín hiệu điều khiển lực trượt dọc u – quỹ đạo hình sin (MPC-O)
(96)h) Tín hiệu điều khiển mơ-men quay trở r có ràng buộc với giả thiết giá trị ràng
buộc 4
1,7.10 ( )N m r 1,7.10 ( )N m
– quỹ đạo hình sin (MPC-O)
Hình 2.18 Kết mơ phỏng, kiểm chứng chất lượng điều khiển MPC-O-QSTT với quỹ đạo hình sin
Nhận xét:
Từ kết mô điều khiển MPC-O-QSTT với quỹ đạo hình sin cho thấy tín hiệu quỹ đạo đầu bám tốt theo quỹ đạo đặt tín hiệu điều khiển
2 r
u có ràng buộc với giả thiết ràng buộc 1,7.10 ( )4 N m r 1,7.10 ( )4 N m Sai lệch bám quỹ đạo ,e e lớn khoảng 5.5m, sai lệch nhỏ so với x y
quỹ đạo chuyển động tàu, sai lệch bám hướng e (lớn 0,1 độ) nhỏ Tín hd
hiệu điều khiển mơ-men quay trở có dao động nhỏ, số lần mô-men thay đổi nằm giới hạn cho phép số lần bẻ lái đơn vị thời gian
Chất lượng điều khiển MPC-O-QSTT phụ thuộc vào việc chọn ma trận xác định dương ,R Q , cửa sổ dự báo N khoảng thời gian trượt T a
Như vậy, trường hợp biến trạng thái , ,u v r mơ hình tàu thủy ba bậc
(97)2.4 Chứng minh tính ổn định hệ điều khiển dự báo đề xuất
Quay lại xét điều khiển phản hồi trạng thái u z xây dựng theo k( k) thuật tốn MPC trình bày mục để điều khiển hệ phi tuyến (2.66) (có cấu trúc song tuyến – bilinear giống cấu trúc mơ hình tàu thủy ba bậc tự mặt ngang):
1 ( ) ( )
( )
k k k k k
k k k
x A x x B x u
y C x x
(2.66)
sao cho đầu y bám theo quỹ đạo tín hiệu mẫu k w cho trước Khác k
với thuật toán điều khiển dự báo phi tuyến khác, thuật toán MPC đề xuất luận án xây dựng tuyến tính hóa đoạn trục thời gian hệ song tuyến thời điểm k 0,1, thành:
1 k k
k k k
k k k
z z u
y z
(2.67)
với
1
( ) ( ) ( )
, , , ,
0
k k k k
k k k
k k
x A x B x B x
z C
u I I
rồi sau sử dụng thuật tốn MPC tuyến tính cửa sổ dự báo để xác định tín hiệu điều khiển u z thời điểm k k( k)
Điều cho phép số phép tính phải thực vòng lặp ứng với 0,1,
k giảm đáng kể, mà thay phải tìm nghiệm tốn tối ưu phi tuyến ta cần tìm nghiệm tốn tối ưu tuyến tính
Tiếp theo, ta chứng minh điều khiển MPC luận án, làm cho đầu hệ tuyến tính hóa đoạn (2.67) tiệm cận tới dãy giá trị tín hiệu đặt
, 0,1,
k
w k làm cho đầu hệ song tuyến (2.66) ban đầu tiệm cận tới tín hiệu đặt Lời chứng minh sau chia làm hai phần:
Thứ nhất, chứng minh điều khiển MPC đề xuất luận án làm đầu
ra hệ (2.67) tiệm cận tới dãy giá trị đặt wk, k 0,1,
Thứ hai, ta chứng minh đầu hệ (2.67) bám tiệm cận theo
, 0,1,
k
(98)Trước tiên, ta chứng minh điều khiển dự báo MPC phản hồi trạng thái luận án, ký hiệu u z , làm đầu hệ (2.67) tiệm cận tới k( k)
, 0,1,
k
w k Ở đây, hệ (2.67) có chứa thành phần tích phân, nên có điều khiển làm hệ kín ổn định tiệm cận làm đầu
k
y hệ bám tiệm cận theo w Bởi đủ ta cần chứng k
minh điều khiển dự báo (thiết kế theo thuật tốn MPC mục trên) có tín hiệu điều khiển uk thời điểm k 0,1, xác định theo tiêu chuẩn tối ưu cửa sổ dự báo tương ứng:
mink N T T
k i i i i i i
i k
J z Q z u R u
với k 0,1, (2.68)
sẽ làm ổn định tiệm cận cho riêng thành phần trạng thái hệ (2.67):
1 k k
k k k
z z u (2.69)
trong tất ma trận ,Q R đối xứng xác định dương (và tùy chọn) i i
Khơng tính tổng qt, sau ta xét trường hợp toán tối ưu (2.68) có ma trận Q R giống tất vòng lặp i, i k 0,1,, tức có:
1
i i N
Q Q Ri Ri N 1 với i (2.70) Vì tốn tối ưu (2.68) với tất cặp ma trận Q R xác định dương, có quan i, i hệ zi,ui cho (2.69) tuyến tính, nên tốn tối ưu tồn phương chặt Do đó, ln có nghiệm nghiệm Điều nói tín hiệu điều khiển dự báo uk thời điểm k phải thỏa mãn tính chất nguyên lý tối ưu Bellman, tức phải thỏa mãn:
k
k k
u z
với k Rk kTLk k1 kTLk k (2.71) ma trận L ma trận xác định ngược bước từ điểm cuối k
i k N tới điểm đầu ik vòng lặp theo công thức:
1 1
T T T T
i k i k i k k i k k i k i k k i k
(99)Có thể thấy từ công thức (2.72) Qk i ,Rk i xác định dương nên nghiệm lặp L k i k Ni, 1 ma trận đối xứng xác định dương, tất nhiên có L Khi đó, sử dụng hàm xác định dương: k
( ) T
k k k k k
V z z L z (2.73)
thì theo nguyên lý quy hoạch động, với quy ước (2.70), điều khiển phản hồi trạng thái tối ưu (2.71) thỏa mãn:
1
, ,
, ,
min
min
( )
k k N
k k N
k N
T T T
k k k k k i i i i i i
u u i k
k N
T T
T T
k k k k k k i i i i i i
u u i k
V z z L z z Q z u R u
z Q z u R u z Q z u R u
1 1 1
1 1 1
, ,
1 1
min
( ) ( ) ( )
k k N
T T
T T
k k k k k k k N k N k N k N k N k N
k N T
T T
k N k N k N k N k N k N i i
u u i k
T
i i
T T
k k
k k N k k N k k N
z Q z u R u z Q z u R u
z Q z u R u z Qz
u R u
z z Q z z u u R
1 1
, ,
1
min
( )
( ) ( )
k k N
k k N
k N T T
i i i i i i
u u i k
k k k k
u u
z Q z u R u
z V z
đó:
1 1
(zk) (zk zk N )TQ zk( k zk N ) ( uk uk N )TRk( uk uk N )
Nhưng Q R hai ma trận xác định dương, nên k, k k(zk) hàm xác định dương Suy ra:
1
( ) ( ) ( )
k zk Vk zk V zk k
là hàm xác định âm Vậy theo tiêu chuẩn Lyapunov, hệ kín gồm đối tượng điều khiển tuyến tính hóa đoạn trục thời gian, mơ tả mơ hình (2.69) điều khiển dự báo u zk( k) phản hồi trạng thái, ổn định tiệm cận
(100)theo tín hiệu đặt wk, k 0,1, Ký hiệu sai lệch trạng thái tuyến tính hóa đoạn mơ hình khoảng cửa sổ dự báo k Khi thành phần trạng thái hệ (2.66) biểu diễn xác bởi:
1 k k
k k k k
z z u (2.74)
Với mơ hình thay xác (2.74) (mà chất mơ hình tương đương) việc chứng minh đầu y hệ (2.66) bám theo tín hiệu k
đặt w thay tương đương việc chứng minh tính ổn định hệ k
(2.74) sử dụng điều khiển dự báo phản hồi trạng thái u zk( k)
Lại sử dụng ứng hàm Lyapunov (2.73) cho hệ (2.74), ta có: 1
( ) ( ) T ( )
k k k k k k k k k
V z z L V z
Hay Vk1(zk1)V zk( k) k(zk) TkLk k k(zk)max k (2.75) với max 0 giá trị riêng lớn L Điều chứng tỏ véc-tơ k trạng thái z hệ (2.74) nằm xa gốc tọa độ để có: k
2 max
( )
k zk k
hay k1max k 2 zk
thì với Vk1(zk1)V zk( k)0, trạng thái z hệ (2.76) có xu hướng tiến k gốc Nói cách khác, khơng phụ thuộc giá trị đầu, quỹ đạo trạng thái z ln có xu k hướng tiến lân cận gốc, ký hiệu , xác định sau:
max k
k k k
z z
(2.76)
(101)2.5 Kết luận chƣơng
Chương luận án trình bày nguyên lý điều khiển trượt dọc trục thời gian điều khiển dự báo MPC, phương pháp nâng cao chất lượng điều khiển dự báo tối ưu hóa có ràng buộc
Đưa giải pháp xây dựng điều khiển dự báo phản hồi trạng thái (MPC-S) phản hồi đầu (MPC-O) cho đối tượng tàu thủy mô hình xác định dạng song tuyến sở tuyến tính hóa đoạn mơ hình phi tuyến dọc theo trục thời gian Kết mô điều khiển MPC-S MPC-O cho chất lượng bám quỹ đạo tốt
Xây dựng quan sát trạng thái trực tiếp từ mơ hình liên tục đối tượng với giả thiết khơng có nhiễu đo cho kết quan sát bám tốt với tín hiệu thực Xây dựng thuật toán quan sát Kalman mở rộng (EKF), đề xuất giải pháp sử dụng quan sát EKF có kết hợp với quan sát trực tiếp việc lựa chọn tín hiệu trạng thái bước khởi tạo ban đầu (0)x Kết mô cho thấy trường hợp tín hiệu trạng thái khơng có nhiễu đo chất lượng quan sát trực tiếp tốt quan sát EKF, cịn trường hợp tín hiệu trạng thái có lẫn nhiễu đo phương án sử dụng quan sát EKF
Chứng minh tính ổn định điều khiển dự báo đề xuất sở tuyến tính hóa đoạn mơ hình dọc trục thời gian
(102)CHƢƠNG ĐIỀU KHIỂN CHUYỂN ĐỘNG TÀU THỦY BÁM QUỸ ĐẠO ĐẶT VỚI BỘ ĐIỀU KHIỂN DỰ BÁO KHI MÔ HÌNH TÀU CĨ CHỨA
THÀNH PHẦN BẤT ĐỊNH
Nội dung chương này, luận án giải vấn đề thiết kế khiển dự báo sở tuyến tính hóa đoạn mơ hình phi tuyến dọc theo trục thời gian để điều khiển chuyển động tàu bám quỹ đạo đặt mô hình tàu có chứa thành phần bất định (mơ hình bất định)
Từ mục tiêu nội dung nghiên cứu bao gồm: xây dựng mơ hình bù bất định đề xuất thiết kế ước lượng, bù bất định Kết hợp ước lượng, bù thành phần bất định với thuật toán điều khiển dự báo MPC-S, MPC-O xây dựng chương để thiết kế điều khiển chuyển động tàu thủy bám theo quỹ đạo đặt mơ hình tàu có chứa thành phần bất định
3.1 Cấu trúc mơ hình bù thành phần bất định
Khi phân tích động lực học tàu thủy mặt phẳng ngang, để có thê mơ tả đầy đủ tính chất động lực học tàu thủy, mơ hình tốn mơ tả chuyển động tàu thủy phải xét đến yếu tố bất định mơ hình thành phần nhiễu ngẫu nhiên từ môi trường tác động tới chuyển động tàu thủy Các yếu tố bất định mơ hình phân tích mục 1.1.5.2 luận án Mơ hình tàu có xét đến thành phần bất định phân tích chương viết lại sau:
( )
( ) ( ) ( ) ( , )
J
M C D g F
(3.1)
Trong đó: F – ma trận phân bổ lực, với mơ hình tốn tàu thủy có dạng thiếu cấu chấp hành (3.1) ma trận phân bổ lực đưa sau:
1 0
F
(103)( , ) – thành phần bất định (khơng xác định) mơ hình tốn nhiễu ngẫu nhiên (được ký hiệu w (1.21)) từ môi trường tác động vào đối tượng
Tiếp theo luận án mở rộng kết từ điều khiển MPC-S, MPC-O có chương cho trường hợp mơ hình tàu thủy ba bậc tự mặt phẳng ngang có chứa thêm thành phần bất định ( , ) mô tả (3.1) Thành phần bất định ( , ) biểu diễn khơng gian ảnh Hình 3.1 Đối tượng nghiên cứu luận án mơ hình tốn tàu thủy dạng thiếu cấu chấp hành, giới hạn luận án xét đến thành phần bất định ( , ) thuộc không gian tập ảnh F ký hiệu ( , ) , tức ( , ) Im( ) F không xét đến thành phần bất định nằm ngồi khơng gian tập ảnh F , chẳng hạn ''
( , ) Im( )F
( , )
( , )
tập ảnh F Không gian ( , )
Hình 3.1 Biểu diễn khơng gian ảnh thành phần bất định ( , )
Với định hướng đó, mơ hình tàu thủy (3.1) chuyển dạng song tuyến thực với mô hình tàu xác định chương sau:
3 3
1
( )
( ( , ))
( ) ( ) ( )
J
G M C D M F
0 0
(3.2)
trong 03 3 ma trận không kiểu 3 (3 hàng cột)
(104)
3 3
3 3
1
1 2
( )
( ) , , ,
( ) ( ) ( )
J x
A x B C I
G x M C x D x M F
0 0
0 (3.3)
với ( ), ( )A x B x ma trận có kiểu 6 2 , (3.2) viết lại thành:
( ) ( , )
x A x x B u d x t
y C x
(3.4)
trong tham số mơ hình ( ), ,A x B C suy từ mơ hình gốc ban đầu (3.1)
Nếu so sánh mô hình (3.4) với mơ hình xác định có (2.45) mơ hình có chứa thành phần bất định (3.4) có thêm thành phần bất định ( , )d x t Giải pháp
của luận án nhận dạng bù thành phần bất định Khi đó, ký hiệu kết nhận dạng thành phần bất định là:
( , ) ( , )
d x t d x t với sai lệch d x t( , )d x t( , ) e vơ nhỏ, (3.5)
thì sau bù ( , )d x t đầu vào cho hệ bất định (3.4), trở gần giống hệ có mơ hình xác định (2.45) mà luận án xây dựng điều khiển dự báo cho Nói cách khác, sau bù bất định ta lại hoàn toàn áp dụng thuật tốn điều khiển MPC-S hay MPC-O có để điều khiển hệ có mơ hình bất định mơ tả Hình 3.2 đây, mà lúc xem hệ có mơ hình xác định (chỉ sai khác lượng vô bé e đầu vào)
( , )
d x t
( )
u t
( , )
d x t
( )
y t
Nhận dạng thành phần bất định
Tàu thủy
(105)3.2 Giải pháp bù thành phần bất định
Thông thường, gặp thành phần bất định ( , )d x t mơ hình đối tượng
điều khiển, phương pháp phổ thông áp dụng dùng mạng Neural, tức khối nhận dạng thành phần bất định mơ tả Hình 3.2 mạng Neural Ngay toán điều khiển tàu thủy có nhiều tài liệu cơng bố ứng dụng mạng Neural RBF (Radial Basis Function) để nhận dạng thành phần bất định ( , )d x t , kể mơ hình đủ thiếu cấu chấp hành giống
như đối tượng nghiên cứu luận án, ví dụ gần cơng trình [14], [63], [68] sử dụng mạng Neural RBF để nhận dạng thành phần nhiễu bất định Bởi vậy, việc áp dụng mạng Neural để bù bất định khơng cịn mang tính thời khơng hứa hẹn có tính luận án
3.2.1 Bù thành phần bất định
Như phân tích trên, thay việc áp dụng mạng Neural để bù thành phần bất định, sau luận án đề xuất riêng phương pháp ước lượng xấp xỉ
( , ) ( , )
d x t d x t sở sử dụng mơ hình khơng liên tục đối tượng, phương pháp đề cập [6] Cơ sở cho việc đề xuất dựa nhận xét tàu thủy hệ biến đổi nhanh, nên hai lần khoảng thời gian trượt (khoảng thời gian nhỏ) ta xem thành phần bất định số, tức suốt trình điều khiển ( , )d x t xem hàm bất
định số đoạn
Xét mơ hình tàu thủy ba bậc tự mặt phẳng ngang dạng mô hình liên tục (3.1) Bây viết dạng không liên tục thời điểm k (nhờ phép biến đổi rời rạc hóa tuyến tính hóa đoạn mơ hình dọc trục thời gian thực chương với mơ hình xác định) với thành phần bất định hàm d đầu k
vào, bù bất định tín hiệu bất định ước lượng dk1 có từ vịng điều khiển trước mơ tả Hình 3.2 Nó có mơ hình là:
1
1
( ) k k k
k A k k B u d d
(3.6)
trong đó:
1 3
3
1
( ) ( ) ( ) ,
, ( ), ( )
a
k k k
a k k a k a
A I T M C D
B T M F u kT d d kT
(106)Ký hiệu tiếp mơ hình mẫu lý tưởng tương ứng (khơng chứa thành phần bất định) thời điểm k là:
1
1
( ) k k
k A k k B u d
(3.8)
trong k trạng thái mơ hình mẫu lý tưởng (khơng chứa thành phần bất định) Khi đó, có đầu vào uk1 nên sai lệch k k k hai mô hình hồn tồn phụ thuộc vào thành phần bất định d Điều giúp ta xác k định xấp xỉ dk dk từ sai lệch mô hình k phục vụ việc bù bất định vịng lặp sau, tức thời điểm k1
Từ (3.6) (3.8) có sai lệch mơ hình k k k sau:
1 1 1 1
1 1
( ) ( ) ( )
( ) ( )
k k k k k
k k k k k
k
k k k k
A B u d d A B u d
A A Bd
(3.9)
Suy ra, trường hợp ma trận B có đủ hạng 2, thì:
1 1
( ) ( )
T T
k k k k k k k
d d B B B A A (3.10) cơng thức xác định xấp xỉ bất định dk dk từ sai lệch mô hình
k k k
, véc-tơ trạng thái đối tượng k1 véc-tơ trạng thái mơ hình mẫu
k
Trong k, k1 đo quan sát từ hệ thống k1, k có từ (3.8) Sau có d ta tiến hành bù đầu vào hệ (3.4) thời điểm k k1 minh họa Hình 3.2
Ta thấy việc đưa mơ hình bất định (3.4) khơng hạn chế nhiều tính tổng qt nó, mà thành phần bất định lại nằm ma trận tham số ( )A x ,
tức có ( , )A x d thay có ( )A x mơ hình (3.4) Đây trường hợp
mà ma trận ( )D ma trận M C, ( ) mơ hình liên tục (3.1) mơ hình tàu ba bậc tự mặt phẳng ngang có chứa thêm tham số bất định luận án đề cập chương Lúc này, trường hợp hệ thiếu cấu chấp hành, song thành phần bất định d lại thuộc khơng gian ảnh Im( )B , tức
(107)/ / /
( , ) ( ) ( , ) ( ) ( )
A x d x A x x A x d A x x
A x x d
(3.11)
với / /
( , ) ( )
d Bd A x d A x x ,
trong d thành phần bất định thay cho d ban đầu / A x thành phần /( )
ma trận tham số không chứa d ( , )A x d Vậy tốn lại trở dạng có
bất định nằm kênh đầu vào mơ hình (3.4) 3.2.2 Mô ƣớc lƣợng bù bất định
Cài đặt tham số ƣớc lƣợng bù bất định
Các thông số cài đặt ước lượng bù bất định bao gồm:
Thời gian lấy mẫu Ta 0.01 0.2 (s), khoảng thời gian trượt dọc trục thời gian điều khiển (receding horizon), thời gian lấy mẫu ngắn độ xác ước lượng cao
Giá trị ước lượng ban đầu (0)d Trong d giá trị bất định ước lượng từ tín hiệu bất định d ước lượng bất định
Để kiểm tra chất lượng ước lượng thành phần bất định xây dựng Luận án tiến hành thử nghiệm với hai trường hợp tín hiệu bất định khác
Thứ nhất: tín hiệu bất định hàm đầu vào nhiễu bất định từ bên ngồi
mơi trường tác động vào (bất định tương đương với tác động sóng, gió, dịng chảy ) Dạng tín hiệu bất định thử nghiệm gồm loại: hình sin (giống tài liệu [14] [21] thử nghiệm), dạng bất định ngẫu nhiên (random), dạng bất định xung vng
Thứ hai: tín hiệu bất định thành phần sinh từ mơ hình thay đổi
(108)3.2.2.1 Mô kiểm chứng ƣớc lƣợng với tín hiệu bất định dạng hàm bất định tác động từ bên
Kiểm chứng ƣớc lƣợng với tín hiệu bất định dạng hình sin
Giả thiết tín hiệu bất định gồm thành phần d ( ,d d1 2), d có tác động tương 1 đương với lực gây trượt dọc ( )u d có tác động tương đương với mô-men 2 quay trở ( )r có độ lớn dạng sau: d1(0.008sin(0.1 ) 0.01).10 ( )t N ,
6
2 (0.001sin(0.2 ) 0.01cos(0.3 )).10 ( )
d t t N m
a) Kết mơ tín hiệu ước lượng d từ thành phần bất định 1 d 1
b) Kết mơ tín hiệu ước lượng d từ thành phần bất định 2 d 2 Hình 3.3 Kết mô ước lượng d d từ thành phần bất định 1, 2 d d với tín 1, 2
(109)Kiểm chứng ƣớc lƣợng tín hiệu bất định dạng ngẫu nhiên (random)
Hình 3.4 Kết mơ tín hiệu ước lượng d từ thành phần bất định 2 d 2 với tín hiệu bất định giả thiết dạng tín hiệu Random
Kiểm chứng ƣớc lƣợng tín hiệu bất định dạng xung vng
Hình 3.5 Kết mơ tín hiệu ước lượng d , từ thành phần bất định 2 d 2 với tín hiệu bất định giả thiết dạng xung vuông
Nhận xét
Từ kết mô ước lượng bất định với tín hiệu bất định tác động từ bên ngồi khác cho thấy, tín hiệu bất định ước lượng d từ ước lượng bám tốt tín hiệu bất định giả thiết d , với sai lệch bám ước lượng nhỏ
3.2.2.2 Mô kiểm chứng ƣớc lƣợng với tín hiệu bất định sinh từ mơ hình đối tƣợng
(110)tiến hành kiểm tra thành phần bất định ước lượng d d từ ước lượng 1, 2 thay đổi tăng, giảm hệ số ma trận thủy động lực học ( )D mơ hình liên tục đối tượng với trường hợp sau:
( ) 1.1 ( )
D D , D( ) 1.05 ( ) D , D( ) 0.95 ( )D
a) Kết ước lượng thành phần bất định d từ thay đổi ma trận ( )1 D
b) Kết ước lượng thành phần bất định d từ thay đổi ma trận ( )2 D
Hình 3.6 Kết ước lượng thành phần bất định d d thay đổi hệ số ma trận 1, 2
thủy động lực học D( ) mơ hình
Nhận xét:
(111)3.2.2.3 Đánh giá ƣớc lƣợng bù bất định
Kết mơ hai trường hợp cịn cho thấy chất lượng ước lượng bất định phụ thuộc vào giá trị ước lượng ban đầu (0)d Nếu chọn ban đầu gần giá trị thực chất lượng ước lượng tốt Tuy nhiên, không phụ thuộc vào giá trị ban đầu chọn, sai lệch ước lượng giảm dần tiệm cận
Chất lượng ước lượng bất định phụ thuộc vào độ lớn dạng tín hiệu bất định, biên độ tín hiệu bất định lớn sai lệch ước lượng lớn theo Kết ước lượng bất định tốt tín hiệu bất định dạng hàm, trơn Ngồi phụ thuộc vào thời gian trượt dọc trục thời gian điều khiển Với tín hiệu bất định khơng lớn ước lượng bất định đề xuất hồn tồn áp dụng để ước lượng chúng
Sau đây, luận án sử dụng kết hợp phương pháp ước lượng với điều khiển dự báo MPC-S, MPC-O xây dựng chương để thiết kế điều khiển dự báo điều khiển bám quỹ đạo tàu thủy mô hình tàu có chứa bất định hàm đầu vào
3.3 Thiết kế điều khiển dự báo điều khiển chuyển động tàu thủy bám quỹ đạo đặt mơ hình có bất định hàm đầu vào
3.3.1 Thiết kế điều khiển dự báo bù bất định phản hồi trạng thái
3.3.1.1 Thuật toán điều khiển dự báo bù bất định phản hồi trạng thái
(112)( , )
d x t
( )
u t
k
d
Nhận dạng thành phần bất định theo
(3.10) Tàu thủy Bộ điều khiển
dự báo MPC-S ZOH
{wk}
k
x
k
u
a
T
,
Hình 3.7 Cấu trúc điều khiển dự báo phản hồi trạng thái có bù bất định
(113)Bắt đầu
( , )
k k k
x col Đo:
Tính:A theo (2.49).k
, k, k
k
H b r theo (2.51), (2.52)
Tính
k k
u d
Đƣa: điều khiển đối tượng liên tục (2.40) hay (2.45) Gán:
0
x x
0
u u
0
A A
Trạng thái từ đối tượng điều khiển (2.40)
1
( k )
A
Và theo (3.7)
Tính: k theo (3.8), ước lượng bất định dk theo (3.10)
0
d d
Tùy chọn:
0, 0,
T T
Q Q R R
2, N
Ma trận xác định dương
Cửa sổ dự báo thời gian trích mẫuTa
Gán:
Tính ,B C theo (2.44) B C B, , theo (2.49), (3.7)
Giá trị khởi tạo k0,u10,e0 0,A0 ,x0
Hệ số hiệu chỉnh tín hiệu đặt0K 1
0
d
Tìm:
*
p theo (2.56), sau tính uk
Nghiệm tối ưu theo (2.57)
k gh
u u
đúng
Gán:
RR
sai sai sai Kết thúc :
k k
Ràng buộc tín hiệu điều khiển =
Lệnh dừng điều khiển =1
Hệ số hiệu chỉnh giá trị ràng buộc1,ugh
?
?
?
(114)3.3.1.2 Cài đặt điều khiển dự báo bù bất định phản hồi trạng thái DMPC-S Các tham số điều khiển DMPC-S cài đặt sau:
Cửa sổ dự báo: N 2 (cài đặt N 5)
Thời gian trượt (receding horizon) Ta 0.1( )s
Tham số hiệu chỉnh tín hiệu đặt 0K1 (cài đặt K 0.5) Tín hiệu điều khiển ban đầu u1 thời điểm t1 (cài đặt u10)
Ma trận xác định dương ,Q R , (đặt Q diag ([50;50;100]), R diag ([1;1])) Giá trị ban đầu quỹ đạo:
Quỹ đạo hình trịn: xd(0)0,yd(0)50,d(0)0
x(0)0, (0)y 30, (0) 0, (0)u 0, (0)v 0, (0)r 0 Quỹ đạo hình sin: xd(0)5,yd(0)30,d(0)0,
x(0)5, (0)y 30, (0) 0, (0)u 0, (0)v 0, (0)r 0 Cài đặt ràng buộc tín hiệu điều khiển mô-men quay trở ugh r gh.
Giá trị ước lượng ban đầu (0)d ước lượng bù bất định, (trong d giá trị ước lượng từ tín hiệu bất định d ), (cài đặt (0) 0d )
Tín hiệu bất định hàm đầu vào giả thiết gồm thành phần d ( ,d d1 2):
Thành phần thứ nhất: nhiễu bất định tác động theo chiều chuyển động trượt
dọc tàu với giá trị giả thiết (0.008sin(0.1 ) 0.01).10 ( )
d t N , làm cho tàu
trượt dọc
Thành phần thứ hai: nhiễu bất định tác động theo chiều chuyển động trượt
ngang tàu với với giá trị giả thiết:
2 (0.001sin(0.2 ) 0.01cos(0.3 )).10 ( )
d t t N m làm cho tàu dạt ngang thay đổi
hướng
(115)3.3.1.3 Kết mô phỏng, đánh giá chất lƣợng điều khiển DMPC-S a Kết mơ với quỹ đạo hình trịn
a) Kết mô quỹ đạo chuyển động – quỹ đạo hình trịn (DMPC-S)
b) Sai lệch bám quỹ đạo – quỹ đạo hình trịn (DMPC-S)
c) Sai lệch bám hướng – quỹ đạo hình trịn (DMPC-S)
(116)e) Thành phần bất định d ước lượng từ 1 d – quỹ đạo hình trịn (DMPC-S) 1
f) Tín hiệu điều khiển lực trượt dọc u bù thành phần bất định ước lượng
1
d – quỹ đạo hình trịn (DMPC-S)
g) Tín hiệu điều khiển lực trượt dọc r chưa bù bất định – quỹ đạo hình trịn
(117)i) Tín hiệu điều khiển mơ-men quay trở r bù thành phần bất định ước lượng
được d – quỹ đạo hình trịn (DMPC-S) 2
Hình 3.9 Kết mơ phỏng, kiểm chứng chất lượng điều khiển DMPC-S với quỹ đạo hình trịn
b Kết mơ với quỹ đạo hình sin
a) Kết mơ quỹ đạo chuyển động – quỹ đạo hình sin (DMPC-S)
(118)c) Sai lệch bám hướng – quỹ đạo hình sin (DMPC-S)
d) Tín hiệu điều khiển lực u chưa bù bất định – quỹ đạo hình sin (DMPC-S)
e) Thành phần bất định d ước lượng từ 1 d – quỹ đạo hình sin (DMPC-S) 1
f) Tín hiệu điều khiển lực trượt dọc u bù thành phần bất định ước lượng
1
(119)g) Tín hiệu điều khiển mơ-men r chưa bù bất định – quỹ đạo hình sin (DMPC-S)
h) Thành phần bất định d ước lượng từ 2 d – quỹ đạo hình sin (DMPC-S) 2
i) Tín hiệu điều khiển mơ-men quay trở r bù thành phần bất định ước lượng
được d – quỹ đạo hình sin (DMPC-S) 2
(120)c Nhận xét:
Kết mô điều khiển DMPC-S với quỹ đạo đặt hình trịn hình sin, có tín hiệu bất định hàm đầu vào, bất định giả thiết với giá trị:
6 (0.008sin(0.1 ) 0.01).10 ( )
d t N ,d2 (0.001sin(0.2 ) 0.01cos(0.3 )).10 ( )t t N m cho kết tín hiệu quỹ đạo đầu điều khiển DMPC-S bám tốt theo quỹ đạo đặt, điều chứng tỏ tín hiệu bất định ước lượng bù tốt vào tín hiệu điều khiển
Sai lệch bám quỹ đạo ,e e lớn 4.2 m với quỹ đạo hình trịn 4.5m với x y
quỹ đạo hình sin, sai lệch bám hướng e tương đối nhỏ khoảng 1.5 độ hd
Tín hiệu bất định ước lượng d d từ tín hiệu bất định giả thiết 1, 2 d d có 1, 2 sai lệch bám nhỏ (sai lệch bám ước lượng thể hình Hình 3.9e, Hình 3.9h với quỹ đạo hình trịn Hình 3.10e, Hình 3.10h với quỹ đạo hình sin)
Tín hiệu điều khiển lực trượt dọc u1u, mơ-men quay trở u2 r có độ điều chỉnh nhỏ Hai tín hiệu điều khiển u u có khác trường hợp 1, 2 chưa bù bù thành phần bất định Sự khác trường hợp có thành phần bất định tín hiệu điều khiển bù thêm lượng bất định ước lượng từ ước lượng Tín hiệu điều khiển bù thay đổi theo tín hiệu bất định Dấu độ lớn tín hiệu điều khiển u, r bù bất định ln có xu hướng bù (khử) thành phần bất định giả thiết tác động vào đối tượng Điều thể rõ đặc tính mơ Hình 3.9d, e, f với tín hiệu u g, h, i với tín hiệu r quỹ đạo đặt hình trịn Hình 3.10d, e, f với tín hiệu u g, h, i với tín hiệu r quỹ đạo đặt hình sin
Chất lượng điều khiển DMPC-S phụ thuộc vào việc chọn ma trận xác định dương ,Q R , số cửa sổ dự báo N khoảng thời gian trượt T (receding a
horizon)
3.3.2 Thiết kế điều khiển dự báo bù bất định phản hồi đầu
3.3.2.1 Thuật toán điều khiển dự báo bù bất định phản hồi đầu
(121)bất định theo (3.10) Tuy nhiên, ta khơng có trạng thái T
k u v r
từ hệ thống (khơng đo được), mà quan sát nhờ quan sát trực tiếp (Hình 2.10), nhờ lọc Kalman mở rộng (EKF) trình bày mục 2.3.2.2, tức có k k, với k trạng thái quan sát từ k quan sát trạng thái nên cơng thức xác định tín hiệu bù bất định cho (3.10) viết lại thành:
1 1
( ) ( )
T T
k k k k k k k
d B B B A A (3.12) Cấu trúc điều khiển dự báo phản hồi đầu có bù bất định minh họa Hình 3.11
( , )
d x t
( )
u t
k d
Tàu thủy Bộ điều khiển
dự báo MPC-S ZOH
{wk} k
u
a T
Quan sát trạng thái Bộ điều khiển dự báo MPC-O
k
x
Nhận dạng thành phần bất định theo (3.12)
k
x
Hình 3.11 Cấu trúc điều khiển dự báo phản hồi đầu có bù bất định
(122)Bắt đầu
Tính: theo (2.62)
theo (2.52), (2.61) Sau tính
đúng
Gán:
0
x x
0
u u
0
k
, ,
k Hk k
r b
Tính: k theo (3.8), ước lượng bất định theo (3.12)
k d
0
d d
Tùy chọn:
0, 0,
T T
Q Q R R 2,
N
Ma trận xác định dương
Cửa sổ dự báo thời gian trích mẫuTa
Gán:
Tính B C, theo (2.44) B C B, , theo (2.49), (3.7)
Giá trị khởi tạok 0,u10,e0 0, 0 ,x0 Hệ số hiệu chỉnh tín hiệu đặt 0K 1
0
0 ,
y d
Đo: Đầu rayk k,quan sát xk k nhờ QSTT EKF
Tìm:
*
p theo (2.64), sau tínhu theo (2.65)k
Nghiệm tối ưu
k gh
u u
đúng
Gán:
RR
sai
sai
k k
u d
Đƣa: điều khiển đối tượng liên tục (2.40) hay (2.45)
sai
đúng
Kết thúc
:
k k
Ràng buộc tín hiệu điều khiển =
Lệnh dừng điều khiển =1
Hệ số hiệu chỉnh giá trị ràng buộc1,ugh
A(k)
và theo dạng (3.7)
?
?
?
(123)3.3.2.2 Mô điều khiển dự báo bù bất định phản hồi đầu DMPC-O Các tham số cài đặt điều khiển DMPC-O sau:
Cửa sổ dự báo: N 2 (cài đặt N 5)
Thời gian trượt (receding horizon) Ta 0.1( )s
Tham số hiệu chỉnh tín hiệu đặt 0K1 (đặt K 0.5) Tín hiệu điều khiển ban đầu u1 thời điểm t1 (đặt u10)
Ma trận xác định dương ,Q R , (đặt Q diag ([50;50;100]); R diag ([1;1])) Giá trị ban đầu quỹ đạo:
Quỹ đạo hình trịn: xd(0)0,yd(0)50,d(0)0
x(0)0, (0)y 50, (0) 0, (0)u 0, (0)v 0, (0)r 0 Quỹ đạo hình sin: xd(0)5,yd(0)30,d(0)0
x(0)5, (0)y 30, (0) 0, (0)u 0, (0)v 0, (0)r 0 Giá trị ban đầu (0), (0), (0)u v r QSTT:
Quỹ đạo hình trịn: (0) 0, (0) 0, (0) 0u v r
Quỹ đạo hình sin: (0) 0, (0) 0, (0) 0u v r
(trong , ,u v r giá trị trạng thái quan sát từ , ,u v r )
Cài đặt ràng buộc tín hiệu điều khiển mơ-men quay trở ugh r gh.
Giá trị ước lượng bất định ban đầu (0)d bù bất định, (đặt (0)d 0) Tín hiệu bất định hàm đầu vào giả thiết với thành phần d ( ,d d1 2)
Thành phần thứ nhất: nhiễu bất định tác động theo chiều chuyển động trượt dọc
của tàu, giả thiết
1 (0.008sin(0.1 ) 0.01).10 ( )
d t N , làm cho tàu trượt dọc
Thành phần thứ hai: nhiễu bất định tác động theo chiều chuyển động trượt
ngang tàu, giả thiết
2 (0.001sin(0.2 ) 0.01cos(0.3 )).10 ( )
d t t N m làm cho tàu
dạt ngang thay đổi hướng
(124)3.3.2.3 Kết mô phỏng, đánh giá chất lƣợng điều khiển DMPC-O a Kết mô với quỹ đạo hình trịn
a) Kết mơ quỹ đạo chuyển động – quỹ đạo hình trịn (DMPC-O)
b) Sai lệch bám quỹ đạo – quỹ đạo hình trịn (DMPC-O)
c) Sai lệch bám hướng – quỹ đạo hình trịn (DMPC-O)
(125)e) Sai lệch bám tốc độ quay trở từ QSTT – quỹ đạo hình trịn (DMPC-O)
f) Tín hiệu điều khiển lực u chưa bù bất định – quỹ đạo hình trịn (DMPC-O)
g) Thành phần bất định d ước lượng từ 1 d – quỹ đạo hình trịn (DMPC-O) 1
h) Tín hiệu điều khiển lực trượt dọc u bù thành phần bất định ước lượng
1
(126)i) Tín hiệu điều khiển mơ-men quay trở r chưa bù bất định – quỹ đạo hình
trịn (DMPC-O)
j) Thành phần bất định d ước lượng từ 2 d – quỹ đạo hình trịn (DMPC-O) 2
k) Tín hiệu điều khiển mơ-men quay trở r bù thành phần bất định ước lượng
được d – quỹ đạo hình trịn (DMPC-O) 2
(127)b Kết mơ với quỹ đạo hình sin
a) Kết mô quỹ đạo chuyển động – quỹ đạo hình sin (DMPC-O)
b) Sai lệch bám quỹ đạo – quỹ đạo hình sin (DMPC-O)
c) Sai lệch bám hướng – quỹ đạo hình sin (DMPC-O)
(128)e) Sai lệch bám tốc độ quay trở từ QSTT – quỹ đạo hình sin (DMPC-O)
f) Tín hiệu điều khiển lực u chưa bù bất định – quỹ đạo hình sin (DMPC-O)
g) Thành phần bất định d ước lượng từ 1 d – quỹ đạo hình sin (DMPC-O) 1
h) Tín hiệu điều khiển lực trượt dọc u bù thành phần bất định ước lượng
1
(129)i) Tín hiệu điều khiển mơ-men r chưa bù bất định–quỹ đạo hình sin (DMPC-O)
j) Thành phần bất định d ước lượng từ 2 d – quỹ đạo hình sin (DMPC-O) 2
k) Tín hiệu điều khiển mơ-men quay trở r bù thành phần bất định ước lượng
được d – quỹ đạo hình sin (DMPC-O) 2
(130)c Nhận xét
Kết mô điều khiển DMPC-O với quỹ đạo đặt hình trịn hình sin, với tín hiệu bất định hàm đầu vào giả thiết gồm hai thành phần
1 ( , )
d d d với giá trị giả thiết:
1 (0.008sin(0.1 ) 0.01).10 ( )
d t N
2 (0.001sin(0.2 ) 0.01cos(0.3 )).10 ( )
d t t N m
cho kết tín hiệu quỹ đạo đầu điều khiển DMPC-O bám tốt theo quỹ đạo đặt, chứng tỏ tín hiệu bất định ước lượng bù tốt điều khiển Sai lệch bám quỹ đạo ,e e lớn 4.2 m với quỹ đạo hình trịn 4.5m với x y
quỹ đạo hình sin, sai lệch bám hướng e tương đối nhỏ khoảng 1.5 độ hd
Tín hiệu bất định ước lượng d d từ tín hiệu bất định giả thiết 1, 2 d d có 1, 2 sai lệch bám nhỏ (sai lệch bám ước lượng thể Hình 3.13g, j với quỹ đạo hình trịn Hình 3.14g, j với quỹ đạo hình sin)
Tín hiệu trạng thái u v rT (tốc độ trượt dọc, trượt ngang, quay trở) quan sát từ QSTT có sai lệch bám , ,e e e nhỏ (thể Hình 3.13d, Hình u v r
3.13e với quỹ đạo hình trịn Hình 3.14d, Hình 3.14e với quỹ đạo hình sin)
Tín hiệu điều khiển lực trượt dọc u1u, mơ-men quay trở u2 r có độ q điều chỉnh nhỏ, nằm giới hạn chấp nhận được, tín hiệu điều khiển u u từ 1, 2 điều khiển DMPC-O trường hợp chưa bù thành phần bất định có dao động nhỏ, dạo động phần ảnh hưởng từ tín hiệu trạng thái quan sát từ QSTT Hai tín hiệu điều khiển u, r có khác trường hợp chưa bù bù thành phần bất định hàm, khác trường hợp mơ hình có thành phần bất định tín hiệu điều khiển bù thêm lượng bất định ước lượng Dấu độ lớn tín hiệu điều khiển u, r bù bất định có xu hướng bù (khử) thành phần bất định giả thiết tác động vào đối tượng (điều thể đặc tính mơ Hình 3.13f, g, h, i, j, k với quỹ đạo hình trịn Hình 3.14f, g, h, i, j, k với quỹ đạo hình sin)
Chất lượng điều khiển DMPC-O phụ thuộc vào việc chọn ma trận xác định dương ,Q R , số cửa sổ dự báo N khoảng thời gian trượt T (receding a
(131)3.4 Kết luận chƣơng
3.4.1 Những vấn đề thực đƣợc
Để thiết kế điều khiển bám quỹ đạo tàu thủy với mơ hình tàu ba bậc tự thiếu cấu chấp hành mặt ngang mơ hình chứa thành phần bất định hàm đầu vào, chương luận án giải vấn đề sau:
Xây dựng mơ hình bù bất định với tín hiệu bất định hàm đầu vào cho đối tượng tàu thủy có mơ hình song tuyến
Xây dựng phương pháp ước lượng bù bất định sở tàu thủy đối tượng có tham số động học biến đổi chậm Mô ước lượng tín hiệu bất định với tín hiệu thử bất định khác cho kết ước lượng tốt Xây dựng cấu trúc, thuật toán điều khiển dự báo bù bất định phản hồi trạng thái (DMPC-S) phản hồi đầu (DMPC-O) sở kết hợp điều khiển MPC-S, MPC-O ước lượng bù bất định Kết mô điều khiển DMPC-S, DMPC-O cho quỹ đạo đầu bám theo quỹ đạo đặt với sai lệch bám nhỏ
3.4.2 Các vấn đề cịn tồn
Trong q trình thiết kế điều khiển DMPC-S, DMPC-O thuật toán chưa đưa quy luật cụ thể để chọn ma trận xác định dương ,Q R
(132)CHƢƠNG XÂY DỰNG MƠ HÌNH THỰC NGHIỆM, KIỂM CHỨNG, ĐÁNH GIÁ CHẤT LƢỢNG BỘ ĐIỀU KHIỂN ĐÃ ĐỀ XUẤT
4.1 Phƣơng pháp kiểm nghiệm điều khiển chạy thời gian thực (Real time)
Mô phương pháp hay sử dụng để nghiên cứu, phân tích đối tượng, chuẩn bị cho việc thiết kế hệ thống Thực mơ giảm chi phí thiết kế chế tạo sản phẩm mới, tránh sai sót khơng đáng có ứng dụng thực tế Nhưng hạn chế mơ hình mơ khơng phản ánh xác đối tượng theo thời gian thực Vì vậy, thực mơ thời gian thực (real time) bước vô quan trọng nhằm đánh giá chất lượng điều khiển tác động từ mơi trường ngồi đến hệ thống Cơ sở thực mô thời gian thực cài đặt phần cứng vào mạch vòng điều chỉnh cấu trúc mô Các phương pháp mô thời gian thực Hình 4.1
Hình 4.1 Các phương pháp mơ thời gian thực
(133)Hình 4.2 Mô HIL cho thấy đáp ứng điều khiển thời gian thực, với kích thích ảo thực tế Do mơ thời gian thực khơng cho phép ta đánh giá khả phần cứng mà giúp ta đánh giá khả phần mềm điều khiển điều kiện môi trường khác
Hình 4.2 Cấu trúc lai mơ thời gian thực
4.2 Xây dựng mô hình thực nghiệm, kiểm chứng điều khiển MPC đề xuất theo phƣơng pháp HIL (Hardware In the Loop)
4.2.1 Cấu trúc mơ hình thực nghiệm HIL với điều khiển MPC
Đối với đối tượng có cấu trúc phức tạp, hoạt động mơi trường phức tạp khơng có khả làm thử nghiệm thực tế hồn tồn tàu thủy phương pháp thực nghiệm theo HIL giải pháp tốt để đánh giá, thử nghiệm điều khiển trền thời gian thực
Cấu trúc mơ hình thực nghiệm HIL với điều khiển MPC luận án đề xuất có cấu trúc Hình 4.3 bao gồm: máy tính cài đặt điều khiển MPC, máy tính cài đặt đối tượng điều khiển, Card giao tiếp Matlab Arduino Due để truyền nhận liệu
Bộ điều khiển MPC thiết kế theo thuật toán MPC-S, MPC-O, DMPC-S, DMPCO cài đặt máy tính số (PC1) Card ghép nối máy tính Arduino Due
(134)MSS-GNC TOOLBOX giống mơ hình tàu thực, có đầy đủ tính chất động học đối tượng tàu thực, cài đặt máy tính số (PC2) Card kết nối vào/ra Arduino Due
Hình 4.3 Cấu trúc mơ hình thực nghiệm HIL với điều khiển MPC đề xuất
Tín hiệu điều khiển từ điều khiển MPC (trên PC1) đưa sang điều khiển đối tượng (trên PC2) thơng qua tín hiệu truyền nhận Analog (tín hiệu tương tự) Card Arduino Due Luận án sử dụng tín hiệu điều khiển đối tượng (trên PC2) tín hiệu Analog với mục đích để kiểm tra ảnh hưởng nhiễu mơi trường tới tín hiệu điều khiển Và việc sử dụng tín hiệu điều khiển dạng Analog để phù hợp với thực tế điều khiển chuyển động tàu thủy, tín hiệu điều khiển đo kiểm tra OSCILLOSCOPE
(135)hướng tàu theo chuẩn Hàng hải quốc tế NMEA 0183 Và thực tế tàu thủy tín hiệu quỹ đạo, hướng tàu lấy từ GPS la bàn điện đưa vào điều khiển tín hiệu theo chuẩn NMEA0183
4.2.2 Thƣ viện mơ thiết bị hàng hải MSS-GNC Toolbox
MSS-GNC (Marine System Simulator - Guidance Navigation Control) Toolbox thư viện dùng để mô đối tượng, hệ thống điều khiển, dẫn đường lĩnh vực Hàng hải MSS-GNC Toolbox tác giả Thor I Fossen Tristan Perez xây dựng phần mềm Mathwork phiên Matlab từ 2007 trở lại Thư viện MSS-GNC Toolbox mô tả đầy đủ mơ hình vật lý thiết bị, hệ thống điều khiển lĩnh vực Hàng hải, thể Hình 4.4 bao gồm:
Hệ thống dẫn đường,
Hệ thống lái tự động, ổn định động (DP), hệ thống điều khiển lắc ngang,… Mơ hình tàu, mơ hình cấu thực chân vịt, bánh lái, mơ hình mơ tả động học,…
Mơ hình mơ tả nhiễu loạn mơi trường: sóng, gió, dịng chảy,… Mơ hình thiết bị đo báo dẫn đường: Radar, La bàn, GPS,…
Hình 4.4 Thư viện mô hệ thống điều khiển Hàng hải MSS-GNC
(136)hành cài đặt file MSS.GNC.TOOLBOX.exe để tạo thư viện MSS Simulink Hình 4.5 Khi cài đặt xong thư viện MSS-GNC sử dụng thư viện sẵn có Matlab - Simulink
Hình 4.5 Thư viện MSS-GNC Toolbox cài đặt Simulink-Matlab
Chi tiết thư viện ứng dụng điều khiển chuyển động tàu thủy MSS-GNC Toolbox trình bày phần phụ lục PL4 luận án
4.2.3 Card ghép nối Arduino Due R3, thƣ viện Arduino Libarary I/O
Card Arduino bo mạch mã nguồn mở, Arduino lưu trữ chương trình điều khiển, hoạt động độc lập với chức thực luật điều khiển, kết nối với máy tính, kết nối với thiết bị Arduino khác, hay thiết bị điện tử khác…Card Arduino Due R3 vi mạch điện tử điều khiển dựa tảng chip AT91XAM3X8EA, tích hợp tất tính cần thiết vi điều khiển Cấu trúc Card Arduino Due R3 hình Hình 4.6
(137)Hình 4.6 Card ghép nối máy tính Arduino due R3 giao tiếp với Matlab
Một ưu điểm bật Card Arduino Due R3 kết nối với máy tính qua cổng USB giao tiếp với phần mềm Matlab - Simulink thông qua thư viện Arduino I/O cài đặt Simulink Hình 4.7 Do chương trình điều khiển Matlab xuất tín hiệu điều khiển ngoại vi nhận tín hiệu từ ngoại vi vào thơng qua Card Arduino Due R3
(138)4.2.4 Ghép nối mơ hình thực nghiệm HIL, cài đặt thơng số với điều khiển MPC đề xuất
4.2.4.1 Mơ hình tàu, mơ hình nhiễu bất định tham số cài đặt
Đối tượng sử dụng để thực nghiệm tàu thủy có mơ hình tốn dạng thiếu cấu chấp hành lấy từ thư viện Vessel Model MSS-GNC, với tham số cài đặt lấy từ tài liệu [21] Các thông số tàu tham số mơ hình tàu khai báo, cài đặt m.file riêng liệu thông số tàu File liệu khai báo và lưu vào Workspace Matlab chạy chương trình m.file
Tín hiệu điều khiển từ điều khiển MPC (trên PC1) u1u,u2 r kết nối từ cổng vào tương tự P1, P2 Card Arduino 2, chân DAC0 đước nối tới P1, chân DAC1 đước nối tới P2
Tín hiệu quỹ đạo thực tàu (trên PC2) phản hồi điều khiển (trên PC1) thông qua kết nối qua cổng COM3 Transmitter Card Arduino 1, Mơ hình nhiễu bất định tác động vào đối tượng xây dựng khối Disturbances Chi tiết sơ đồ kết nối mơ hình đối tượng PC2 Hình 4.8
(139)4.2.4.2 Xây dựng, cài đặt mơ hình nhiễu đo
Thực tế tàu thủy tín hiệu từ thiết bị đo dẫn đường Radar, La bàn, GPS,…đều chịu ảnh hưởng nhiễu đo từ môi trường sóng, gió, dịng chảy,… Do để kiểm tra chất lượng điều khiển, quan sát cần tạo mơ hình nhiễu đo tác động vào thiết bị đo hướng quỹ đạo la bàn GPS Mơ hình nhiễu đo lấy từ thư viện Model Environment MSS-GNC Tool box Trên mơ hình cho phép thay đổi tham số cài đặt giá trị cường độ tác động nhiễu đo khác nhau, tham số cài đặt Hình 4.9
Hình 4.9 Mơ hình nhiễu đo tham số cài đặt
4.2.4.3 Ghép nối, cài đặt mơ hình đo tín hiệu quỹ đạo, hƣớng tàu GPS - Gyrocompass
(140)Hình 4.10 Mơ hình xác định quỹ đạo, hướng GPS- GYRO
4.2.4.4 Ghép nối, cài đặt Card Arduino Due R3 Atemega16u2 chuyển đổi tín hiệu NMEA0183
Trên tàu thủy tín hiệu quỹ đạo, hướng tàu xác định GPS - GYRO tín hiệu theo chuẩn Hàng hải (dạng tín hiệu NMEA 0183) Để đánh giá ảnh hưởng nhiễu từ mơi trường tới tín hiệu quỹ đạo, hướng tàu theo chuẩn NMEA 0183 Luận án tiến hành chuyển đổi tín hiệu quỹ đạo, hướng tàu thực tàu dạng số (từ PC2) sang tín hiệu theo chuẩn NMEA 0183 truyền thông qua cổng Seri COM3 Card Arduino tới cổng Seri COM3 Card Arduino Tín hiệu quỹ đạo, hướng tàu dạng NMEA 0183 chuyển đổi lại sang tín hiệu số qua Card Arduino trước đưa vào điều khiển PC1
Code khai báo chuyển đổi tín hiệu NMEA0183 giao tiếp Card Arduino với Matlab - Simulink máy tính thơng qua thư viện Arduino I/O library đưa phần phụ lục
4.2.4.5 Mơ hình điều khiển MPC cài đặt máy tính (PC1)
(141)(142)4.2.4.6 Hình ảnh mơ hình vật lý thực nghiệm HIL với điều khiển MPC đề xuất
a) Hình ảnh tổng thể mơ hình vật lý
(143)d) Hình ảnh đo tín hiệu Oscilloscope e) Hình ảnh Card kết nối Arduino Due
f) Hình ảnh cấp nguồn ổn áp 5V cho Card Arduino Due
Hình 4.12 Hình ảnh mơ hình vật lý thực nghiệm phịng thí nghiệm Mơ hình hóa tại trường Đại học Hàng hải Việt Nam
4.3 Kết thực nghiệm, kiểm chứng điều khiển MPC đề xuất
(144)a) Quỹ đạo chuyển động tàu mơ hình MSS-GNC
b) Sai lệch bám quỹ đạo
c) Sai lệch bám hướng
(145)e) Sai lệch quan sát tốc độ quay trở
f) Tín hiệu điều khiển lực trượt dọc u u1 chưa bù bất định
g) Ước lượng d từ thành phần bất định 1 d 1
(146)i) Tín hiệu điều khiển mô-men quay trở r u2 chưa bù bất định
j) Ước lượng d từ thành phần bất định 2 d 2
(147)l) Tín hiệu điều khiển u, r đo từ Oscilloscope
Hình 4.13 Kết thực nghiệm HIL với điều khiển DMPC-O-quỹ đạo hình trịn
Nhận xét kết thực nghiệm:
Kết thực nghiệm điều khiển đề xuất DMPC-O với đối tượng mơ hình tàu MSS-GNC Tool box cho đặc tính quỹ đạo, đặc tính quan sát, đặc tính ước lượng bù bất định đặc tính tín hiệu điều khiển giống mơ (quỹ đạo tàu bám tốt quỹ đạo đặt, tín hiệu quan sát QSTT với sai lệch nhỏ, ước lượng bất định ước lượng tốt tín hiệu bất định theo giả thiết)
Tuy nhiên so với kết mô điều khiển DMPC-O (hình 3.13) kết thực nghiệm có đặc điểm sau:
Quỹ đạo thực nghiệm với mơ hình tàu MSS-GNC Tool box có tượng dao động nhỏ, điều thể tính quán tính đối tượng tàu thực
Sai lệch bám quỹ đạo, bám hướng, sai lệch quan sát tốc độ trượt dọc, trượt ngang, tốc độ quay trở lớn so với kết mơ (hình 3.13), (nhưng có giá trị nhỏ so với quỹ đạo chuyển động tàu)
Các đặc tính tín hiệu điều khiển, tín hiệu quan sát, tín hiệu ước lượng có trễ thời gian ngắn so với mô khoảng thời gian (tương ứng với khoảng thời gian nhịp truyền nhận tín hiệu qua đường truyền vật lý)
(148)Tín hiệu điều khiển đối tượng u1u,u2 r thơng qua truyền nhận tín hiệu tương tự có tượng dao động nhỏ ảnh hưởng nhiễu mơi trường ảnh hưởng nhỏ
Tín hiệu quỹ đạo hướng thực tàu truyền thơng dạng tín hiệu NMEA0183 Modbus RS485 chịu ảnh hưởng mơi trường ngồi Tuy nhiên, tín hiệu quỹ đạo, hướng đối tượng tín hiệu quỹ đạo, hướng đưa điều khiển có trễ khoảng thời gian nhỏ
4.4 Kết luận chƣơng
Thông qua thực nghiệm theo phương pháp HIL với điều khiển MPC đề xuất, QSTT ước lượng bù bất định mơ hình tàu MSS-GNC thu kết sau:
Kiểm nghiệm chất lượng điều khiển MPC, quan sát trực tiếp, ước lượng bù bất định có ảnh hưởng môi trường vật lý
Kiểm nghiệm chất lượng tín hiệu điều khiển truyền mơi trường vật lý
(149)KẾT LUẬN VÀ KIẾN NGHỊ
Những vấn đề đƣợc giải
Quá trình thực đề tài, luận án giải nội dung sau: Đã nghiên cứu xây dựng thuật toán điều khiển dự báo MPC
sở tuyến tính hóa đoạn mơ hình phi tuyến cho đối tượng tàu thủy có mơ hình tốn dạng thiếu cấu chấp hành mơ hình tàu xác định mơ hình tàu có chứa thành phần bất định Luận án chứng minh điều khiển đề xuất ổn định tiệm cận Điểm thuật toán sử dụng nguyên lý điều khiển MPC tuyến tính để điều khiển đối tượng phi tuyến (tàu thủy), sở tuyến tính hóa đoạn mơ hình phi tuyến dọc theo trục thời gian Ưu điểm điều khiển số lệnh tính tốn ít, thời gian tính tốn nhanh, giải tốn tối ưu đơn giản
2 Đã nghiên cứu xây dựng quan sát trạng thái theo phương pháp quan sát trực tiếp từ mơ hình liên tục tàu thủy ba bậc tự mặt phẳng ngang với giả thiết khơng có nhiễu đo
3 Đã nghiên cứu xây dựng phương pháp ước lượng bù thành phần bất định (phương pháp xấp xỉ thành phần bất định dựa sở tối ưu hóa sai lệch so với mơ hình mẫu) để giải toán điều khiển chuyển động tàu thủy mơ hình có chứa thành phần bất định
4 Xây dựng mơ hình thực nghiệm theo phương pháp HIL để kiểm nghiệm chất lượng điều khiển đề xuất với mơ hình tàu thực MSS-GNC Những vấn đề tồn
Những vấn đề trình thực đề tài mà luận án bỏ ngỏ, chưa giải gồm có:
1 Chưa đưa nguyên tắc chọn hai ma trận đối xứng xác định dương ,
Q R bước khởi tạo ban đầu lưu đồ thuật toán cách tốt
(150)CÁC CƠNG TRÌNH ĐÃ CƠNG BỐ
I Cơng trình cơng bố nƣớc
1 Nguyễn Hữu Quyền, Trần Anh Dũng, Phạm Kỳ Quang (2015): Ổn định lắc
ngang tàu thủy sử dụng phương pháp tồn phương gián tiếp Tạp chí
KHCNHH-Trường Đại học Hàng hải Việt Nam, số 42, 04-2015, trang 40
2 Nguyễn Hữu Quyền, Trần Anh Dũng, Phạm Kỳ Quang (2015): Điều khiển
tối ưu tồn phương tuyến tính chuyển động tàu thủy Tạp chí KHCNHH-Trường
Đại học Hàng hải Việt Nam, số 43, 08-2015, trang 23-27
3 Nguyễn Hữu Quyền, Trần Anh Dũng, (2016): Nâng cao chất lượng ổn định
hướng tàu thủy sử dụng quan sát trạng thái Hội nghị quốc tế khoa học
công nghệ Hàng hải 26-29/10/2016 ISBN: 978-604-937-127-1, trang 373-379 4 Nguyễn Hữu Quyền, Trần Anh Dũng (2017), “Điều khiển chuyển động tàu
cánh ngầm sử dụng phương pháp thích nghi trực tiếp”, Tuyển tập cơng trình
KHCN – Hội thảo điều khiển tự động hóa cho phát triển bền vững CASD – 2017, trang 29
5 Nguyễn Hữu Quyền, Trần Anh Dũng, (2019): Ổn định hướng tàu thủy dựa
trên điều khiển dự báo theo mơ hình Tạp chí KHCNHH-Trường Đại học Hàng
hải Việt Nam, số 58, 04-2019, trang 27-31
6 Nguyễn Hữu Quyền, Trần Anh Dũng, (2019): Điều khiển chuyển động theo
quỹ đạo tàu thủy thiếu cấu chấp hành dựa mơ hình dự báo hệ song tuyến Tạp chí GTVT-Bộ giao thơng vận tải, số 05/2019, trang 126-129
7 Nguyễn Hữu Quyền, Trần Anh Dũng, (2019): Thiết kế điều khiển chuyển
động tàu thủy bám quỹ đạo đặt dựa theo nguyên lý RHC LQR Tạp chí
KHCN-Trường Đại học giao thơng vận tải Hồ Chí Minh, số 32-05/2019, trang 41-46
8 Nguyễn Hữu Quyền, Trần Anh Dũng, Trƣơng Công Mỹ (2019): Xây dựng
bộ điều khiển chuyển động tàu thủy bám quỹ đạo dựa mơ hình dự báo theo ngun lý tách có ràng buộc tín hiệu điều khiển Tạp chí KHCNHH-Trường
(151)9 Nguyễn Hữu Quyền, Trần Anh Dũng, (2019): Điều khiển bám quỹ đạo tàu
thiếu cấu chấp hành dựa mô hình dự báo kết hợp bù thành phần bất định Hội nghị Triển lãm quốc tế lần thứ Điều khiển Tự động hoá
-VCCA-2019, N0 ID42
II Cơng trình cơng bố quốc tế
1 Nguyen, Huu-Quyen, Tran, Anh-Dung, Nguyen, Trong-Thang, (2019): The
Bilinear Model Predictive Method-based Motion Control System of Underactuated-Ship with Uncertain Model in the Disturbance Processes 7,
(152)TÀI LIỆU THAM KHẢO
Tiếng Việt
[1] Đỗ Thị Tú Anh, (2014): Điều khiển dự báo phản hồi đầu theo nguyên lý
tách cho hệ phi tuyến Luận án Tiến sỹ kỹ thuật, Trường Đại học Bách khoa
Hà Nội
[2] Nguyễn Việt Dũng, (2018): Phương pháp mơ hình hóa điều khiển trường
nhiệt độ vật nung dày Luận án Tiến sỹ kỹ thuật, Trường Đại học Bách khoa
Hà Nội
[3] Đặng Xuân Hoài, (1999): Ứng dụng kỹ thuật tự động hóa vi xử lý tàu
thủy đóng Việt Nam Luận án Tiến sỹ kỹ thuật, trường Đại học Bách Khoa
Hà Nội
[4] Nguyễn Doãn Phƣớc, (2012): Phân tích điều khiển hệ phi tuyến NXB Bách khoa
[5] Nguyễn Dỗn Phƣớc, (2016): Tối ưu hóa điều khiển điều khiển tối
ưu NXB Bách khoa
[6] Nguyễn Doãn Phƣớc, Nguyễn Hoài Nam, (2019): Một số phương pháp điều
khiển hệ có mơ hình Euler-Lagrange bất định Hội nghị khoa học toàn quốc
lần thứ Động lực Điều khiển
[7] Khƣơng Minh Tuấn, (2017): Nghiên cứu kiến trúc hướng mơ hình kết hợp
với RealTime UML/MARTE thiết kế hệ thống điều khiển cho phương tiện không người lái tự hành mặt nước Luận án Tiến sỹ kỹ thuật, trường
Đại học Bách Khoa Hà Nội
[8] Hoàng Thị Tú Uyên, (2018): Nghiên Cứu ứng dụng lý thuyết điều khiển
thích nghi để nâng cao chất lượng hệ thống lái tự động tàu có chốn nước
Luận án Tiến sỹ kỹ thuật, trường Đại học Bách Khoa Hà Nội Tiếng Anh
[9] Arimoto,S et.al (1984): Bettering operation of robot by learning Journal of robotic system, 1(2), pp.123-140
[10] Ashrafiuon H, Muske KR, McNinch LC, Soltan RA (2008): Sliding mode
tracking control of surface vessels IEEE Trans Ind Electron 55(11):4004–
(153)[11] Boyd,S and Vandenberghe,L (2004): Convex optimization Cambridge University Press
[12] Bristow,D.A et.al (2006): A Survey of Iterative Learning Control: A
learning-based method for high-performance tracking control IEEE control
systems magazine Vol 26 pp 96-114, 2006
[13] Camacho, Bordons (2004), Model predictive control, Springer Verlag, London
[14] Cheng Liu, Zaojian Zou, Jianchuan Yin (2015): Trajectory tracking of
underactuated surface vessels based on neural network and hierarchical sliding mode, J Mar Sci Technol (2015) 20: 322–330
[15] Dai S.-L., Wang C., and Luo F (2012): Identification and learning control
of ocean surface ship using neural networks, IEEE Transactions on Industrial
Informatics, vol 8, pp 801-810
[16] Do K.D, Jiang ZP, Pan J (2002): Underactuated ship global tracking under
relaxed conditions IEEE Trans Autom Control 47(9):1529–1536
[17] Do K.D, Jiang ZP, Pan J (2002): Universal controllers for stabilization and
tracking of underactuated ships Syst Control Lett 47(4): 299317
[18] Do K.D, Pan J, Jiang ZP (2003): Robust adaptive control of underactuated
ships on a linear course with comfort Ocean Eng 30(17): 2201 25
[19] Do K.D, Jiang ZP (2004): Robust adaptive path following of underactuated, Department of Mechanical and Materials Engineering, The University of Western Australia, Nedlands, WA 6907, Australia
[20] Do K.D and J.Pan (2006): Global robust adaptive path following of
underactuated ships, Automatica, vol 42, no 10, pp 1713–1722, Oct 2006
[21] Do K.D, Jie Pan (2009): Control of Ships and Underwater Vehicles Design
for Underactuated and Nonlinear Marine Systems: Spring Science& Business
Media, 2009
[22] Dongkyoung Chwa (2011): Global Tracking Control of Underactuated Ships
With Input and Velocity Constraints Using Dynamic Surface Control Method,
IEEE Transactions on control systems Technology, Vol.19 N0.6 November 2011
[23] Fossen T I and Berge S P (Year): Nonlinear vectorial backstepping design
(154)dynamics, in Decision and Control, 1997., Proceedings of the 36th IEEE
Conference on, 1997, pp 4237-4242
[24] Fossen T I (1994): Guidance and control of ocean vehicles John Wiley & Sons Inc
[25] Fossen T I and Fjellstad O.-E (1995): Nonlinear modelling of marine
vehicles in degrees of freedom Mathematical Modelling of Systems, vol 1,
pp 17-27
[26] Fossen, T.I and J.P Strand (1999): Passive Nonlinear Observer Design for
Ships Using Lyapunov Methods Experimental Results with a Supply Vessel
Automatica AUT-35(1), pp 3-16
[27] Fossen, T I, (2000): Nonlinear Passive Control and Observer Design for
Ship N0.3 129-184, Modeling, Indentification and Control
[28] Fossen T.I (2002): Marine control systems: guidance, navigation and control
of ships, rigs and underwater vehicles vol 28, 2002
[29] Fossen T I (2011): Handbook of marine craft hydrodynamics and motion
control John Wiley & Sons
[30] Godhavn JM (1996): Nonlinear tracking of underactuated surface vessels In: Proceedings of the 35th IEEE Conference on Decision and Control, pp 975– 980
[31] Grewal,M.S and Andrews,A.P (2001): Kalman filtering: Theory and
Practice using MatLab John Wiley & Sons
[32] Grune, L and Pannek, J (2010): Nonlinear model predictive control Theory
and Algorithms Springer
[33] Huibert, K and Raphael, S (1972): Linear optimal contrrol systems Wiley Interscience
[34] H Saari1 and E Khichane, (2013) Robust Rudder Roll Reduction of
Container Ship, J Automation & Systems Engineering 7-3 (2013): 94-104
[35] Jiang ZP (2002): Global tracking control of underactuated ships by
Lyapunov’s direct method Automatica 38(1):301–309
[36] Jin Cheng, Jianqiang Yi, Dongbin Zhao, (2005) Neural Network Based
Model Reference Adaptive Control for Ship Steering System, International
(155)[37] Koshkouei A J., Zinober A S., and Burnham K J (2004): Adaptive
sliding mode backstepping control of nonlinear systems with unmatched uncertainty, Asian Journal of control, vol 6, pp 447-453
[38] Kramer,O (2017): Genetic Algorithm Essentials, Studies in Computational
Intelligence Springer International Publishing AG
[39] Lefeber E (2000): Tracking control of nonlinear mechanical systems, Ph.D dissertation, Dept Mech Eng., Univ Twente, Twente, The Netherlands, 2000 [40] Lefeber E, Pettersen KY (2001): Way-point tracking control of ships, in
Proc 40th IEEE Conf Decision Control, 2001, pp 940–945
[41] Lefeber E, Pettersen KY, Nijmeijer H (2003): Tracking control of an
underactuated ship IEEE Trans Control Syst Technol 11(1):52–61
[42] Leonessa A., VanZwieten T., and Morel Y (2006): Neural network model
reference adaptive control of marine vehicles, in Current trends in nonlinear
systems and control, ed: Springer, 2006, pp 421-440
[43] Liu,J (2018): Intelligent Control Design and MatLab Simulation Springer [44] Moore,K.L (1993): Iterative learning control for deterministic systems
London, Springer Verlag
[45] Maciejowski,M.J (2011): Predictive control with constraints Prentice Hall [46] Mario E Serrano, Gustavo J E Scaglia, Vicente Mut, Oscar A Ortiz,
Mario Jordan (2013): Tracking Trajectory of Underactuated Surface Vessels:
a Numerical Method Approach, National University of San Juan, Argentine,
CEAI, Vol.15, No.4 pp 15-25, 2013
[47] Movahhed M, Dadashi S and Danesh M (2011): Adaptive sliding mode
control for autonomous surface vessel In: Proceedings of the 2011 IEEE
International Conference on Mechatronics, Istanbul, Turkey, pp 522–527 [48] Mohamed Abdelaal, Martin Franzle, Axel Hahn, (2015): Nonlinear Model
Predictive Control for Tracking of Underactuated Vessels under Input Constraints, IEEE European Modelling Symposium, University of Oldenburg,
Oldenburg, Germany
[49] Mikkel Eske Norgaard Sorensen, Morten Breivik and Bjorn-Olav H Eriksen (2017): A Ship Heading and Speed Control Concept Inherently
Satisfying Actuator Constraints
[50] M J Mahjoob1 and E.Abbasi, (year) Fuzzy LQR Controller for Heading
(156)Automation, School of Mechanical Engineering College of engineering, University of Tehran Tehran, Iran
[51] Nocedal,J and Wright,S.J (1996): Numerical Optimization Springer-New York
[52] Naveen.s, V.Manikandan (2014): Model Predictive Controller for Ship
heading control, International Journal of Industrial Electronics and Electrical
Engineering, ISSN: 2347-6982
[53] Oh SR, Sun J (2010): Path following of underactuated marine surface vessels
using line-of-sight based model predictive control Ocean Eng 37(2–3):289–
295
[54] Phuoc, N.D (2018): Integrating the receding horizon LQR for nonlinear
systems into intelligent control scheme Journal of military science and
technology FEE-8/2018, pp.6-16
[55] Phuoc, N.D and Ha, L.T.T (2015): Constrained Output Tracking Control for
Time-Varying Bilinear Systems via RHC with Infinite Prediction Horizon
Journal of Computer Science and Cybernetics, Vol.31, No.2, pp 97-106 [56] Pettersen KY, Nijmeijer H (2001): Underactuated ship control: theory and
experiments Int J Control 74(14):1435–1446
[57] Perez, T and Mogens Blanke, (2002): Mathematical Ship Modeling for
Control Applications Technical Report Dept of Electrical and Computer
Engineering The University of Newcastle, NSW, 2308, Australia
[58] Perez, T and T I Fossen, (2005): Ship Kinetics Chapter 4, In: ''Ship Motion
Control: Course Keeping and Roll Stabilisation using Rudder and Fins" (T Perez), Advances in Industrial Control Series, Springer-Verlag, 2005, ISBN
1-85233
[59] Rossiter, J.A (2005): Model based predictive control Practical approach CRC Press
[60] Ronghui Li, Tieshan Li, Renxiang Bu, Qinling Zheng, and C L Philip Chen, (2013): Active Disturbance Rejection with Sliding Mode Control Based
Course and Path Following for Underactuated Ships, Received 23 August
2013; Accepted 30 September 2013
(157)[62] Siramdasu Y, Fahimi F (2012): Incorporating input saturation for
underactuated surface vessel trajectory tracking control In: 2012 American
Control Conference, Montre ´al, Canada, pp 6203–6208
[63] Shi-Lu Dai, Shude He, Min Wang and Chengzhi Yuan (Member, IEEE) (2018): Adaptive Neural Control of Underactuated Surface Vessels With
Prescribed Performance Guarantees, IEEE Transactions on neural networks
and learning systems, All content following this page was uploaded by Chengzhi Yuan on 14 November 2018
[64] Shi-Lu Dai, Shude He (2018): Adaptive Tracking Control of Underactuated
Surface Vessels With Model Uncertainties, School of Automation Science and
Engineering, South China University of Technology, Guangzhou, 510641, China
[65] Tongwen,C and Francis,B (1995): Optimal sampled data control systems London: Springer-Verlag
[66] Wenjiang LIU, Qingmei SUI, Hairong XIAO, Fengyu ZHOU, (2011)
Sliding Backstepping Control for Ship Course with Nonlinear Disturbance Observer, Journal of Information & Computational Science 8: 16 (2011)
3809–3817
[67] Werneld E Ngongi and Jialu Du (2015): Controller Design for Tracking
Control of an Under-Actuated Surface Ship, International Journal of Computer
Theory and Engineering, Vol 7, No 6, December 2015
[68] Xiaogong Lin, Huai Jiang, Jun Nie and Yuzhao Jiao (2018):
Adaptive-sliding-mode trajectory tracking control for underactuated surface vessels based on NDO Proceedings of 2018 IEEE International Conference on
Mechatronics and Automation August 5.8, Changchun, China, pp.1043-1049 [69] Yan Peng, Jianda Han and Qi Song, (2007): Tracking Control of
Underactuated Surface Ships: Using Unscented Kalman Filter to Estimate the Uncertain Parameters, Proceedings of the 2007 IEEE International
Conference on Mechatronics and Automation August - 8, 2007, Harbin, China
[70] Yu-lei Liao, Lei Wan, Jia-yuan Zhuang (2011): Backstepping dynamical
(158)Autonomous Underwater Vehicle, Harbin Engineering University, Harbin 150001, China
[71] Yang Yang, Jialu Du, Hongbo Liu, Chen Guo, and Ajith Abraham, (2014): A Trajectory Tracking Robust Controller of Surface Vessels With
Disturbance Uncertainties, IEEE Transactions On Control Systems
Technology, Vol 22, NO 4, July 2014
[72] Yong Liu, Renxiang Bu, Xiaori Gao (2018): Ship Trajectory Tracking
Control Systems Design Based on Sliding Mode Control Algorithm, Polish
Maritime reseach (99) 2018 Vol 25; pp 26-34
[73] Zhang Y, Peng P.Y, and Jiang Z.P (2000): Stable neural controller design
for unknown nonlinear systems using backstepping, IEEE Transactions on
Neural Networks, vol 11, pp 1347-1360
[74] Zilouchian, A and Jamshidi, M (ed 2001): Intelligent control systems using
Soft computing methodologies CRC press
[75] Zhiquan Liu (2018), Ship Adaptive Course Keeping Control With Nonlinear
Disturbance Observer, Digital Object Identifie 10.1109/ACCESS 2017.2742001
[76] Zewei Zheng, Cheng Jin, Ming Zhu, Kangwen sun (2018): Trajectory
(159)PHỤ LỤC
1 Lực tác động nhiễu: Sóng, gió, dịng chảy
a Lực mômen sinh nhiễu loạn sóng biển:
Lực mơmen sóng biển tác động lên bề mặt tàu mơ tả sau:
waves waves waves waves
T
W X Y Z (A.1)
Trong đó: Xwaves, Ywaves, Zwaves đưa lý thuyết phi tuyến [28] biểu diễn sau:
waves waves 2 waves 1 24 N i i N i i N i i
X t gBLTcos S t
Y t gBLTsin S t
N t gBL L B sin S t
(A.2) Trong đó:
L – chiều dài phần mớn nước tàu B – chiều rộng phần mớn nước tàu T – chiều cao phần mớn nước tàu
– hướng sóng i
S – độ dốc sóng
g – gia tốc trọng trường – tỷ trọng nước
b Lực mô men sinh tác động gió:
Vectơ lực tổng quát sinh tác động gió coi sau:
wind wind wind wind
T
W X Y Z
(160) wind wind wind 2
X r a r T
Y r a r L
N r a r L
X C V A
Y C V A
N C V A L
(A.3) Trong đó: , X Y
C C – hệ số lực, C – hệ số mơmen, N a – mật độ khơng khí (Kg/m3),
T
A – diện tích mặt ngang (m2),
L
A – diện tích mặt bên (m2), L – chiều dài tàu
(m) Và r góc hướng gió so với hướng mũi tàu, V – tốc độ gió r 2 Bảng thơng số tàu sử dụng mô thực nghiệm
Bảng PL1 Giá trị thông số, hệ số mơ hình tàu sử dụng mơ [21]
Thông số Giá trị Thông số Giá trị
Chiều dài tàu 32m
Khối lượng 118x10 Kg 3
Bán kính lượn vịng tối thiểu tàu 150m Lực trượt dọc tối đa chân vịt tàu
có thể tạo umax
9 5, x10 ( )N
Mômen quay trở tối đa bánh lái tàu tạo rmax
8 8.5 x10 ( m)N
11
m
120 x10 (Kg) d11 ( 2)n u 43x10 (Kgm )2 1
22
m
177.9 x10 (Kg) d11 ( 3)n u 21.5 x10 (Kgm2 2)
33
m
636 x10 (Kgm ) d11 ( 2)n v 23.4 x10 (Kgm )3 1 11
d
215 x10 (Kgs ) d11 ( 3)n v 11.7 x10 (Kgm3 2)
22
d
177 x10 (Kgs ) d11 ( 2)n r 160.4 x10 (Kgm ) 4 33
d 802x10 (Kgm s )4 1
11 ( 3)n r
d
80.2 x10 (Kgm s)
, , 0,
ui vi ri
(161)3 Mơ hình mơ điều khiển MPC đề xuất
Hình PL3.1 Sơ đồ mơ điều khiển MPC-S (mơ hình xác định)
Hình PL3.2 Sơ đồ mơ điều khiển MPC-O-QSTT (mơ hình xác định)
(162)Hình PL3.4 Sơ đồ mơ điều khiển DMPC-O-QSTT (mơ hình bất định)
4 Thƣ viện mô thiết bị Hàng hải MSS-GNC
Các thư viện ứng dụng điều khiển chuyển động tàu MSS-GNC
Thư viện mơ hình tàu (Model vessel): thư viện bao gồm loại mơ hình tàu xây dựng sẵn như: tàu hàng, tàu dịch vụ, kho nổi…Hình PL4.1 Các mơ hình tàu thể đầy đủ tính chất động học, chất vật lý loại tàu Với loại tàu cho phép cài đặt đầy đủ thông số đối tượng tàu cụ thể
(163)Thư viện cấu chấp hành (Model control surface): thư viện bao gồm loại mơ hình cấu thực xây dựng sẵn như: mô hình chân vịt, mơ hình bánh lái…Hình PL4.2
Hình PL4.2 Thư viện cấu chấp hành MSS-GNC Toolbox
Thư viện thiết bị dẫn đường (Navigation): thư viện bao gồm loại mơ hình thiết bị dẫn đường xây dựng sẵn GPS, la bàn…Hình PL4.3
Hình PL4.3 Thư viện thiết bị đo, quan sát tín hiệu hàng hải MSS-GNC
(164)Hình PL4.4 Thư viện loại nhiễu loạn môi trường MSS-GNC Toolbox
5 Code khai báo, giao tiếp Card Arduino với Matlab – Simulink máy tính thơng qua thƣ viện Arduino I/O library
>> COM 1= arduino1 % Connect PC1 (Controlller) Updating server code on board Mega due (COM1) ans =
arduino with properties: Port: 'COM1' Board: 'Megadue'
AvailablePins: {'D2-D53', 'A0-A15'} % Output A0, A1 Libraries: {'I2C', 'Servo', 'SPI'}
>> COM 1= arduino due % Connect PC2 (Vessel) Updating server code on board Mega due (COM2) ans = arduino with properties:
Port: 'COM1' Board: 'Megadue'
AvailablePins: {'D2-D53', 'A0-A15'} % Input D4, D5 Libraries: {'I2C', 'Servo', 'SPI'}
(165)Cấu hình cổng COM2-Arduino (USART1) giao diện với GPS, Gyro Compass… qua giao thức NMEA0183
USART1 initialization
Communication Parameters: Data, Stop, No Parity USART1 Receiver: On
USART1 Transmitter: On USART1 Mode: Asynchronous USART1 Baud rate: 4800 or 38400 UCSR1A=0x00;
UCSR1B=0xD8; UCSR1C=0x86; UBRR1H=0x00;
if (PINC.0) //The switch for transfer between 4800 and 38400 Baud rate {
UBRR1L=0x8F; //8F cho 4800 }
else {
UBRR1L=0x11; //11 cho 38400 }
Cấu hình cổng COM3- Arduino (USART2) giao diện với Modbus RS485 (PC) USART0 initialization
Communication Parameters: Data, Stop, No Parity USART0 Receiver: On
USART0 Transmitter: On USART0 Mode: Asynchronous USART0 Baud rate: 115200 UCSR0A=0x00;
(166)6 Một số hình kết nghiệm mơ hình vật lý phịng thí nghiệm chạy Real Time
a) Hình ảnh đối tượng tàu MSS-GNC với đặc tính chạy Real time
b) Hình ảnh điều khiển MPC với các đặc tính chạy Real time
c) Hình ảnh đặc tính điều khiển đo Oscilloscope chạy Real time
d) Hình ảnh Card Arduino Due chạy Real time
e) Hình ảnh hệ thống thực nghiệm HIL chạy Real time
(Linear Quadratic Gaussian)
![Bảng 1-1 Thành phần chuyển động và tham số động học của tàu thủy [24] - NOI DUNG LATS - NGUYEN HUU QUYEN](https://media.store123doc.com/figures/000/529/bang-thanh-phan-chuyen-dong-dong-hoc-thuy-529789.png)
![Hình 1.2 Các khung tọa độ quy chiếu [24]. - NOI DUNG LATS - NGUYEN HUU QUYEN](https://media.store123doc.com/figures/000/529/hinh-khung-toa-do-quy-chieu-529790.png)
![Hình 1.3 Mô tả động lực học tàu thủy trong khung tọa độ quy chiếu quán tính gắn với trái đất và khung tọa độ gắn thân tàu [24] - NOI DUNG LATS - NGUYEN HUU QUYEN](https://media.store123doc.com/figures/000/529/hinh-dong-hoc-thuy-chieu-tinh-dat-than-529791.png)
![Hình 2.1 Cấu trúc và nguyên lý làm việc của hệ điều khiển dự báo [5]. - NOI DUNG LATS - NGUYEN HUU QUYEN](https://media.store123doc.com/figures/000/529/hinh-cau-truc-nguyen-he-khien-du-bao-529792.png)
