將測量船慣導(dǎo)船搖數(shù)據(jù)等效至測控設(shè)備處的船搖等效方法
【專利摘要】本發(fā)明涉及一種將測量船慣導(dǎo)船搖數(shù)據(jù)等效至測控設(shè)備處的船搖等效方法，所述方法包括以下步驟：根據(jù)慣導(dǎo)測量的船搖數(shù)據(jù)和慣導(dǎo)三軸交點在地心固聯(lián)系下的大地坐標(biāo)以及慣導(dǎo)平臺至測控設(shè)備間變形歐拉角計算經(jīng)度旋轉(zhuǎn)矩陣、緯度旋轉(zhuǎn)矩陣、船搖旋轉(zhuǎn)矩陣和變形歐拉角矩陣；根據(jù)設(shè)備三軸中心在慣導(dǎo)甲板系中坐標(biāo)以及經(jīng)度、緯度、船搖三種旋轉(zhuǎn)矩陣計算設(shè)備三軸中心在地心固聯(lián)系下坐標(biāo)；根據(jù)設(shè)備三軸中心在地心固聯(lián)系下直角坐標(biāo)計算其大地坐標(biāo)；根據(jù)設(shè)備三軸中心在地心固聯(lián)系下大地坐標(biāo)計算設(shè)備的經(jīng)度旋轉(zhuǎn)矩陣和緯度旋轉(zhuǎn)矩陣；計算設(shè)備等效船搖歐拉角矩陣；計算設(shè)備的船搖數(shù)據(jù)。
【專利說明】
將測量船慣導(dǎo)船搖數(shù)據(jù)等效至測控設(shè)備處的船搖等效方法
技術(shù)領(lǐng)域
[0001] 本發(fā)明涉及一種船搖等效方法，主要用于將慣導(dǎo)設(shè)備測量的船搖數(shù)據(jù)通過變形修 正，等效計算到各個測控設(shè)備處。
【背景技術(shù)】
[0002] 航天測量船在海上航行過程中因受風(fēng)、浪、涌等多種因素的影響，會引起船體姿態(tài) 發(fā)生復(fù)雜、不規(guī)則的運動。安裝在船體甲板上的各種測量設(shè)備，同樣受到這種不規(guī)則運動的 影響。研究表明：測量船的測量精度不僅與外測設(shè)備本身精度有關(guān)，而且與測量船船體姿 態(tài)、變形有關(guān)。為修正這種不規(guī)則運動對測量精度的影響，測量船安裝了船載慣性導(dǎo)航設(shè)備 用于實時測量測量船船位及船搖。由于慣導(dǎo)設(shè)備測量的是慣導(dǎo)三軸交點處的船體搖擺角， 而測控設(shè)備三軸中心與慣導(dǎo)三軸中心不在同一位置，慣導(dǎo)測量的船搖角不能直接使用于測 控設(shè)備船搖修正。因此在處理測量設(shè)備測量數(shù)據(jù)或計算測控設(shè)備引導(dǎo)數(shù)據(jù)時必須將慣導(dǎo)測 量的船搖數(shù)據(jù)通過變形修正，等效計算到各個測控設(shè)備處。另外，如果測量船在不同位置安 裝多套船姿測量設(shè)備，在分析不同設(shè)備間船姿測量結(jié)果時，也需要將一套慣導(dǎo)船搖數(shù)據(jù)等 效到另一套慣導(dǎo)設(shè)備處。船搖等效計算是多套船姿測量數(shù)據(jù)融合備份使用、不同測控設(shè)備 精度比對的前提。
[0003] 當(dāng)前船搖等效計算時一般采用平移法。該方法認(rèn)為設(shè)備地平坐標(biāo)系與慣導(dǎo)地平坐 標(biāo)系坐標(biāo)軸指向相同，即設(shè)備三軸中心水平面與慣導(dǎo)三軸交點水平面為同一平面。事實上， 由于地球形狀的影響，對于參考橢球體表面的不同位置，水平面都不相同，因此設(shè)備地平坐 標(biāo)系與慣導(dǎo)地平坐標(biāo)系坐標(biāo)軸指向存在差異。平移法計算船搖等效必然帶來了較大的誤 差。

【發(fā)明內(nèi)容】

[0004] 本發(fā)明所要解決的技術(shù)問題是針對上述現(xiàn)有技術(shù)提供一種考慮地球形狀的船搖 等效計算法，可以顯著提高船搖等效精度，進而提高外測數(shù)據(jù)精度。
[0005] 本發(fā)明解決上述問題所采用的技術(shù)方案為:一種將測量船慣導(dǎo)船搖數(shù)據(jù)等效至測 控設(shè)備處的船搖等效方法，所述方法包括以下步驟： 步驟A、根據(jù)慣導(dǎo)測量的船搖數(shù)據(jù)Κ,?Ρ, 6和慣導(dǎo)三軸交點在地心固聯(lián)系下的大地坐標(biāo) 本以及慣導(dǎo)平臺至測控設(shè)備間變形歐拉角(1^肩為)計算經(jīng)度旋轉(zhuǎn)矩陣￡、煒度旋轉(zhuǎn) 矩陣5、船搖旋轉(zhuǎn)矩陣戽和變形歐拉角矩陣爲(wèi)，其中為艏搖，識為縱搖，右為橫搖，a為經(jīng)度， 逆為煒度，A為高程，

步驟B、根據(jù)測控設(shè)備三軸中心在慣導(dǎo)甲板系中坐標(biāo)以及經(jīng)度旋轉(zhuǎn)矩 陣￡、緯度旋轉(zhuǎn)矩陣S、船搖旋轉(zhuǎn)矩陣矣計算設(shè)備三軸中心在地心固聯(lián)系下坐標(biāo) Y^LBB^+Y (5) 其中
，e2_為參考橢球體第一偏心率的平方， β 為地球赤道半徑； 步驟C、根據(jù)測控設(shè)備三軸中心在地心固聯(lián)系下直角坐標(biāo)十算其大地坐標(biāo)(屯珂Λ)， 計算公式為
步驟D、根據(jù)測控設(shè)備三軸中心在地心固聯(lián)系下大地坐標(biāo)計算設(shè)備的經(jīng)度旋 轉(zhuǎn)矩陣4:、煒度旋轉(zhuǎn)矩陣邳，計算公式為
步驟Ε、計算測控設(shè)備等效船搖歐拉角矩陣，計算公式為： = (9)； 步驟F、根據(jù)測控設(shè)備等效船搖歐拉角矩陣計算測控設(shè)備的船搖數(shù)據(jù)其
，計算公式為
[0006] 與現(xiàn)有技術(shù)相比，本發(fā)明的優(yōu)點在于： 理論分析和數(shù)據(jù)驗證表明，考慮地球形狀能夠減少船搖等效計算過程中的系統(tǒng)誤差， 提高等效數(shù)據(jù)的精度，這將為測量船的船搖數(shù)據(jù)計算以及外測數(shù)據(jù)處理的精度提高提供支 持。
【附圖說明】
[0007] 圖1為本發(fā)明中船位經(jīng)度等效船搖的影響仿真圖。
[0008] 圖2為本發(fā)明中船位煒度等效船搖的影響仿真圖。
[0009] 圖3為本發(fā)明中船位高程等效船搖的影響仿真圖。
[0010] 圖4為本發(fā)明中測控設(shè)備視差對等效船搖的影響仿真圖。
【具體實施方式】
[0011]以下結(jié)合附圖實施例對本發(fā)明作進一步詳細(xì)描述。
[0012]本實施例中的一種將測量船慣導(dǎo)船搖數(shù)據(jù)等效至測控設(shè)備處的船搖等效方法，其 具體過程如下： 步驟A、根據(jù)慣導(dǎo)測量的船搖數(shù)據(jù)K,與0和慣導(dǎo)三軸交點在地心固聯(lián)系下的大地坐標(biāo) (?肩·以及慣導(dǎo)平臺至測控設(shè)備間變形歐拉角計算經(jīng)度旋轉(zhuǎn)矩陣￡、煒度旋轉(zhuǎn) 矩陣5、船搖旋轉(zhuǎn)矩陣藎和變形歐拉角矩陣瑪，其中sc為艏搖，供為縱搖，s為橫搖，：^為經(jīng) 度，為煒度，力為高程，
步驟B、根據(jù)測控設(shè)備三軸中心在慣導(dǎo)甲板系中坐以及經(jīng)度旋轉(zhuǎn)矩
陣乙、緯度旋轉(zhuǎn)矩陣5、船搖旋轉(zhuǎn)矩陣:?計算設(shè)備三軸中心在地心固聯(lián)系下坐標(biāo) Y^LBB^+Y (5) 其中
e_2為參考橢球體第一偏心率的平方，為 地球赤道半徑。
[0013]步驟C、根據(jù)設(shè)備三軸中心在地心固聯(lián)系下直角坐標(biāo)iU十算其大地坐標(biāo)(4與為）， 計算公式為
步驟D、根據(jù)測控設(shè)備三軸中心在地心固聯(lián)系下大地坐標(biāo)計算設(shè)備的經(jīng)度旋 轉(zhuǎn)矩陣4、煒度旋轉(zhuǎn)矩陣緝，計算公式為
步驟Ε、計算測控設(shè)備等效船搖歐拉角矩陣考^，計算公式為：
步驟F、根據(jù)測控設(shè)備等效船搖歐拉角矩陣I計算測控設(shè)備的船搖數(shù)據(jù)其
，則計算公式為
本發(fā)明提供的一種將測量船慣導(dǎo)船搖數(shù)據(jù)等效至測控設(shè)備處的船搖等效方法，消除了 地球形狀對船搖等效計算的誤差，能夠準(zhǔn)確地計算各測控設(shè)備處的船搖數(shù)據(jù)，對于提高測 量船的外測數(shù)據(jù)處理精度具有重要的意義。
[0014] 采用上述方法進行實際測試，表1是兩種等效船搖方法計算偏差比較結(jié)果，可以看 出，利用本文提出的方法進行船搖等效，并將測量系數(shù)據(jù)坐標(biāo)轉(zhuǎn)換至地心固聯(lián)系時處理精 度更高。
[0015] 表2是等效船搖方法誤差對定軌結(jié)果影響結(jié)果，可以看出等效船搖誤差對初軌半 長軸誤差影響從64.5米到1512.9米，若進行高精度軌道計算，等效船搖誤差不容忽視。
[0016] 圖1至圖4是為分析地球形狀對船搖等效的影響，本文仿真不同條件下使用平移法 和本文的船搖等效方法得到的等效船搖數(shù)據(jù)差異。上述仿真數(shù)據(jù)可以看出，等效船搖誤差 與船位經(jīng)度、高程幾乎無關(guān)，與設(shè)備視差呈線性關(guān)系;在低煒度地區(qū)，對縱搖誤差影響較大， 在高煒度地區(qū)，對艏搖誤差影響較大;航向為東西向時，對艏搖誤差影響較大，航向為南北 向時，對艏搖誤差影響較小。
[0017]除上述實施例外，本發(fā)明還包括有其他實施方式，凡采用等同變換或者等效替換 方式形成的技術(shù)方案，均應(yīng)落入本發(fā)明權(quán)利要求的保護范圍之內(nèi)。
【主權(quán)項】
1. 一種將測量船慣導(dǎo)船搖數(shù)據(jù)等效至測控設(shè)備處的船搖等效方法，其特征在于:所述 方法包括W下步驟： 步驟A、根據(jù)慣導(dǎo)測量的船搖數(shù)據(jù)K，與9和慣導(dǎo)Ξ軸交點在地屯、固聯(lián)系下的大地坐標(biāo) 林與知擬及慣導(dǎo)平臺至測控設(shè)備間變形歐拉角(取，稱，馬)計算經(jīng)度旋轉(zhuǎn)矩陣正、締度旋轉(zhuǎn) 矩陣毋、船搖旋轉(zhuǎn)矩陣聲和變形歐拉角矩陣瑪，其中捉為臘搖，與為縱搖，巧為橫搖，為經(jīng)度， 為締度，為高程，步驟B、根據(jù)測控設(shè)備Ξ軸中必在慣導(dǎo)甲板系中坐標(biāo):為，風(fēng)，及經(jīng)度旋轉(zhuǎn)矩陣 亞、締度旋轉(zhuǎn)矩陣毋、船搖旋轉(zhuǎn)矩陣霉計算設(shè)備Ξ軸中屯、在地屯、固聯(lián)系下坐標(biāo)(5) 其中,g2為參考楠球體第一偏屯、率的平方，口為 地球赤道半徑； 步驟C、根據(jù)測控設(shè)備Ξ軸中屯、在地屯、固聯(lián)系下直角坐標(biāo)巧計算其大地坐標(biāo)(沁巧Λ)， 計算公式為(6); 步驟D、根據(jù)測控設(shè)備Ξ軸中屯、在地屯、固聯(lián)系下大地坐標(biāo)(卻，巧，卻)計算設(shè)備的經(jīng)度旋轉(zhuǎn) 矩陣句、締度旋轉(zhuǎn)矩陣馬，計算公式為步驟E、計算測控設(shè)備等效船搖歐拉角矩陣馬1，計算公式為：(9); 步驟F、根據(jù)測控設(shè)備等效船搖歐拉角矩陣巧1計算測控設(shè)備的船搖數(shù)據(jù)(Ki，巧，巧)，其中
【文檔編號】G01C21/20GK106092100SQ201610392497
【公開日】2016年11月9日
【申請日】2016年6月6日 公開號201610392497.5, CN 106092100 A, CN 106092100A, CN 201610392497, CN-A-106092100, CN106092100 A, CN106092100A, CN201610392497, CN201610392497.5
【發(fā)明人】侯亞威, 李永剛, 周錦標(biāo), 胡上成, 郭力兵, 吳金美, 張煜昕, 王恒, 李生平, 汪毅
【申請人】中國人民解放軍63680部隊