亚洲成年人黄色一级片,日本香港三级亚洲三级,黄色成人小视频,国产青草视频,国产一区二区久久精品,91在线免费公开视频,成年轻人网站色直接看

一種船用GPS航向平滑更新方法與流程

文檔序號(hào):12359826閱讀:來源:國(guó)知局

技術(shù)特征:

1.一種船用GPS航向平滑更新方法,其特征在于,包括如下步驟:

S1:獲取GPS第i幀數(shù)據(jù),從GPS第i幀數(shù)據(jù)中解析出經(jīng)緯度i、航向信息i;

S2:若i為1時(shí),將經(jīng)緯度i、航向信息i賦予給導(dǎo)航設(shè)備,導(dǎo)航設(shè)備的位置信息為經(jīng)緯度i、航向newCourse為航向信息i,經(jīng)緯度i、航向信息i作為導(dǎo)航信息后,結(jié)束更新;

S3:若i為大于1的正整數(shù)時(shí),獲取GPS第i-1幀數(shù)據(jù),從GPS第i-1幀數(shù)據(jù)中解析出經(jīng)緯度i-1、航向信息i-1,計(jì)算經(jīng)緯度i-1與經(jīng)緯度i的距離Dist、方位Azimuth;

S4:若距離Dist大于距離門限D(zhuǎn)istTH時(shí),將經(jīng)緯度i、方位Azimuth賦予給導(dǎo)航設(shè)備,導(dǎo)航設(shè)備的位置信息更新為經(jīng)緯度i、航向newCourse更新為方位Azimuth,完成航向平滑更新;

S5:若距離Dist小于或等于距離門限D(zhuǎn)istTH時(shí),則導(dǎo)航設(shè)備的位置信息為經(jīng)緯度i、航向newCourse為航向信息i,然后計(jì)數(shù)器加1,獲取下一幀GPS數(shù)據(jù),直到獲取GPS第i+N幀數(shù)據(jù)時(shí),距離Dist大于距離門限距離DistTH后再執(zhí)行S4。

2.根據(jù)權(quán)利要求1所述的一種船用GPS航向平滑更新方法,其特征在于:所述距離門限D(zhuǎn)istTH為:5米至30米。

3.根據(jù)權(quán)利要求1所述的一種船用GPS航向平滑更新方法,其特征在于:S1步驟前還需執(zhí)行計(jì)算航速步驟,當(dāng)航速小于或等于3米/秒時(shí),再執(zhí)行S1、S2、 S3、 S4、 S5。

當(dāng)前第2頁(yè)1 2 3 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評(píng)論。精彩留言會(huì)獲得點(diǎn)贊!
1