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。