0
B GIÁO DỤC VÀ ĐÀO TẠO
VIN HÀN LÂM KHOA HC
VÀ CÔNG NGH VIT NAM
HC VIN KHOA HC VÀ CÔNG NGH
……..….***………
ƯỚC LƯỢNG TƯ THẾ V TINH NH QUAN SÁT TRÁI ĐẤT
BNG VIC HP NHT HÓA D LIU CA CM BIN
TỐC ĐỘ GÓC VÀ CM BIN SAO
LUN ÁN TIẾN SĨ KỸ THUẬT ĐIỀU KHIN VÀ T ĐỘNG HÓA
Hà Ni 2018
1
VIN HÀN LÂM KHOA HC VÀ CÔNG NGH VIT NAM
HC VIN KHOA HC VÀ CÔNG NGH
……..….***………
ƯỚC LƯỢNG TƯ THẾ V TINH NH QUAN SÁT
TRÁI ĐẤT BNG VIC HP NHT HÓA D LIU
CA CM BIN TỐC ĐỘ GÓC VÀ CM BIN SAO
LUN ÁN TIẾN SĨ KỸ THUẬT ĐIỀU KHIN VÀ T ĐỘNG HÓA
Chuyên ngành: K thuật điều khin và t động hóa
Mã s: 62 52 02 16
Người hướng dn khoa hc:
1. PGS.TS Thái Quang Vinh
2. TS. Bùi Trng Tuyên
Hà Ni 2018
2
LI CAM ĐOAN
Tôi xin cam đoan đây công trình nghiên cu ca riêng tôi, được hoàn
thành dưới s ng dn ca tp th ng dn. Các kết qu nêu trong lun án là
trung thực và chưa từng được công b trong bt k công trình nào khác.
Tôi xin chu trách nhim v nhng lời cam đoan của mình.
Hà Nội , ngày tháng năm 2018
Nghiên cu sinh
Ngô Duy Tân
3
LI CẢM ƠN
Luận án này được hoàn thành ti Hc vin Khoa hc và Công ngh - Vin
Hàn lâm Khoa hc và Công ngh Vit Nam. Trong quá trình nghiên cu, tác gi
đã nhận được nhiu s giúp đỡ quý báu ca các thy cô, các nhà khoa hc, các
đồng nghip, bạn bè và gia đình
Để hoàn thành lun án này, tôi xin chân thành cảm ơn PGS. TS Thái
Quang Vinh TS. Bùi Trng Tuyên đã định hướng, ng dẫn, giúp đ
mọi điều kin thun li trong sut quá trình nghiên cu ca Lun án này.
Tôi xin gi lời cám ơn chân thành đến Ban Lãnh đạo, Phòng Đào tạo Sau
Đại hc Vin Công ngh Thông tin Hc vin Khoa hc Công ngh -Vin
Hàn lâm khoa hc Công ngh Việt Nam đã to mọi điều kin tt nht trong
sut thi gian hc tp và nghiên cứu, để tôi hoàn thành lun án này.
Tôi xin chân thành cm ơn lãnh đo Vin Công ngh trụ các đồng
nghiệp đã tạo điu kiện, giúp đỡ tôi trong qtrình nghiên cu, th nghim
hoàn thin các ni dung nghiên cu ca lun án.
Tôi xin bày t lòng biết ơn đến gia đình, bạn người thân đã luôn quan
tâm, động viên, khích l và giúp đỡ tôi trong quá trình hc tp và nghiên cu.
Xin trân trng cảm ơn.
Hà Ni, ngày tháng năm 2018
Nghiên cu sinh
Ngô Duy Tân
4
MC LC
MC LC ....................................................................................................................... 0
DANH MC CÁC T VIT TT VÀ KÝ HIU ......................................................... 6
DANH MC CÁC HÌNH V ......................................................................................... 8
DANH MC BNG ..................................................................................................... 10
M ĐẦU ....................................................................................................................... 11
CHƯƠNG 1 - TNG QUAN ................................................................................. 16
1.1 Tư thế v tinh .................................................................................................... 16
1.2 Các h ta đ trong kho sát chuyển động ca v tinh .................................... 17
1.3 Biu diễn tư thế v tinh ..................................................................................... 19
1.3.1 Biu diễn tư thế v tinh bng quaternion .......................................................... 20
1.3.2 Biu diễn tư thế v tinh bng các vec-tơ Pivot ................................................. 22
1.3.3 Sai lệch tư thế v tinh ....................................................................................... 24
1.4 Các ch tiêu chính ca phân h xác định và điều khiển tư thế v tinh ............. 25
1.5 Thut toán ưc lượng tư thế và nhng ràng buc trên v tinh ......................... 27
CHƯƠNG 2 - HÌNH V TINH CM BIẾN THẾ TRONG BÀI TOÁN
ƯỚC LƯỢNG TƯ TH V TINH ............................................................................... 31
2.1 Xây dựng mô hình động lc hc ca v tinh với các bánh xe động ợng điều
khiển tư thế v tinh ........................................................................................................ 31
2.1.1 Xây dựng mô hình động lc hc ca v tinh vi các bánh xe động lượng ...... 31
2.1.2 Lut điu khiển tư thế v tinh ........................................................................... 36
2.2 Cm biến tư thế v tinh ..................................................................................... 38
2.2.1 Cm biến tc đ góc ......................................................................................... 38
2.2.2 Cm biến sao .................................................................................................... 41
CHƯƠNG 3 - ƯỚC LƯỢNG THẾ V TINH BNG HP NHT D LIU
ĐA CM BIN 45
3.1 Sơ đồ khi b ước lưng tư thế ........................................................................ 45
3.2 Ước lượng thế bng cm biến sao cm biến tốc độ góc s dụng phương
pháp trng s ................................................................................................................. 47
3.3 S dng b lc Kalman m rng (Extended Kalman Filter - EKF) ................ 49