System.ArgumentOutOfRangeException: 索引和長度必須引用該字符串內(nèi)的位置。 參數(shù)名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技術(shù)實現(xiàn)步驟摘要】
本專利技術(shù)涉及尋北,尤其涉及一種單陀螺尋北儀緯度估計尋北方法。
技術(shù)介紹
1、尋北儀產(chǎn)品一般使用多位置轉(zhuǎn)停方案進行尋北,在角度計算過程中需要知道緯度值和重力加速度值。在某些應(yīng)用中,緯度值不能獲取或者不方便獲取,就需要產(chǎn)品自身具備緯度值估計功能,以便尋北儀完成尋北工作。
技術(shù)實現(xiàn)思路
1、本專利技術(shù)實施例所要解決的技術(shù)問題在于,提供一種單陀螺尋北儀緯度估計尋北方法,以使在無位置初始值情況下通過陀螺和加速度計的輸出來估計出緯度值,完成尋北工作。
2、為了解決上述技術(shù)問題,本專利技術(shù)實施例提出了一種單陀螺尋北儀緯度估計尋北方法,包括:
3、步驟s1:采集尋北儀的原始數(shù)據(jù),對采集的原始數(shù)據(jù)進行補償處理,得到補償處理后的數(shù)據(jù),所述尋北儀的原始數(shù)據(jù)包括陀螺儀和加速度計的原始數(shù)據(jù);
4、步驟s2:建立緯度迭代方程,根據(jù)緯度迭代方程迭代修正得到緯度估計值;
5、步驟s3:根據(jù)緯度估計值重新計算重力加速度和水平姿態(tài)角度并輸出。
6、本專利技術(shù)的有益效果為:本專利技術(shù)在尋北儀的應(yīng)用過程中,能夠通過陀螺儀輸出、姿態(tài)角度信息,迭代估計出緯度值;本專利技術(shù)通過緯度估計后,再進行水平姿態(tài)角的計算,可使尋北儀設(shè)備輸出更為準(zhǔn)確的角度值。
【技術(shù)保護點】
1.一種單陀螺尋北儀緯度估計尋北方法,其特征在于,包括:
2.如權(quán)利要求1所述的單陀螺尋北儀緯度估計尋北方法,其特征在于,步驟S2包括以下子步驟:
3.如權(quán)利要求2所述的單陀螺尋北儀緯度估計尋北方法,其特征在于,預(yù)設(shè)的迭代退出機制包括:
4.如權(quán)利要求3所述的單陀螺尋北儀緯度估計尋北方法,其特征在于,步驟S3中,根據(jù)下式計算重力加速度和水平姿態(tài)角度:
5.如權(quán)利要求1所述的單陀螺尋北儀緯度估計尋北方法,其特征在于,步驟S1中,補償處理包括先對原始數(shù)據(jù)進行溫度補償、工具誤差補償,再通過滑窗平滑的方法進行預(yù)處理,滑窗深度為10。
【技術(shù)特征摘要】
1.一種單陀螺尋北儀緯度估計尋北方法,其特征在于,包括:
2.如權(quán)利要求1所述的單陀螺尋北儀緯度估計尋北方法,其特征在于,步驟s2包括以下子步驟:
3.如權(quán)利要求2所述的單陀螺尋北儀緯度估計尋北方法,其特征在于,預(yù)設(shè)的迭代退出機制包括:
4.如權(quán)利要求3...
【專利技術(shù)屬性】
技術(shù)研發(fā)人員:鄧麟,李漢舟,頡兵杰,
申請(專利權(quán))人:廣東奧斯諾工業(yè)有限公司,
類型:發(fā)明
國別省市:
還沒有人留言評論。發(fā)表了對其他瀏覽者有用的留言會獲得科技券。