[發(fā)明專利]降低北斗衛(wèi)星導(dǎo)航定位裝置定位漂移的方法

無(wú)效

• 申請(qǐng)?zhí)枺?/td>: 201210262204.3
• 申請(qǐng)日: 2012-07-26
• 公開（公告）號(hào): CN102749631A
• 公開（公告）日: 2012-10-24
• 發(fā)明（設(shè)計(jì)）人: 鐘政輝
• 申請(qǐng)（專利權(quán)）人: 海華電子企業(yè)（中國(guó)）有限公司
• 主分類號(hào): G01S19/23
• 分類號(hào): G01S19/23
• 代理公司: 廣州三環(huán)專利代理有限公司 44202
• 代理人: 何傳鋒

技術(shù)領(lǐng)域

本發(fā)明涉及衛(wèi)星定位技術(shù)，尤其涉及一種降低北斗衛(wèi)星導(dǎo)航定位裝置定位漂移的方法。

背景技術(shù)

我國(guó)自行研制的北斗衛(wèi)星導(dǎo)航系統(tǒng)是除美國(guó)的全球定位系統(tǒng)（GPS）、俄羅斯的GLONASS之后的第三個(gè)成熟衛(wèi)星導(dǎo)航系統(tǒng)。2011年12月27日我國(guó)自主建設(shè)的北斗衛(wèi)星導(dǎo)航系統(tǒng)正式開始試運(yùn)行，向中國(guó)以及周邊地區(qū)提供連續(xù)的導(dǎo)航定位和授時(shí)服務(wù)，各類基于北斗衛(wèi)星導(dǎo)航系統(tǒng)的定位設(shè)備也正式投入應(yīng)用。另外，美國(guó)GPS衛(wèi)星定位技術(shù)已有幾十年的發(fā)展歷史，技術(shù)已經(jīng)很成熟，其定位設(shè)備也覆蓋社會(huì)生活的各個(gè)方面。但北斗衛(wèi)星導(dǎo)航系統(tǒng)快速發(fā)展，推動(dòng)了衛(wèi)星導(dǎo)航在國(guó)民經(jīng)濟(jì)社會(huì)各行業(yè)的廣泛應(yīng)用，特別是車輛定位、導(dǎo)航方面。

現(xiàn)在北斗衛(wèi)星定位技術(shù)已經(jīng)日臻成熟，在智能交通和物流等領(lǐng)域得到了大規(guī)模的應(yīng)用，但是在定位精準(zhǔn)度方面，現(xiàn)有北斗衛(wèi)星導(dǎo)航定位裝置會(huì)出現(xiàn)明顯的定位漂移，造成定位時(shí)精準(zhǔn)度出現(xiàn)較大誤差。

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

針對(duì)現(xiàn)有技術(shù)的缺點(diǎn)，本發(fā)明的目的是提供一種降低北斗衛(wèi)星導(dǎo)航定位裝置定位漂移的方法，解決北斗導(dǎo)航定位裝置定位不精準(zhǔn)的問(wèn)題。

為了實(shí)現(xiàn)上述目的，本發(fā)明的技術(shù)方案為：一種降低北斗衛(wèi)星導(dǎo)航定位裝置定位漂移的方法，它包括如下步驟：（1）獲取一段時(shí)間內(nèi)接收到的定位數(shù)據(jù)，并將其按照定位時(shí)間進(jìn)行排序；（2）從第一個(gè)定位數(shù)據(jù)點(diǎn)開始，計(jì)算相鄰兩個(gè)定位點(diǎn)之間的距離，并根據(jù)兩個(gè)定位點(diǎn)之間的時(shí)間間隔計(jì)算車輛的行駛速度；（3）如果所述車輛的行駛速度過(guò)高，超過(guò)了現(xiàn)實(shí)中可能達(dá)到的最大值，則將這兩個(gè)定位點(diǎn)刪除。

在步驟（1）中設(shè)定過(guò)濾定位點(diǎn)的定位開始時(shí)間和定位結(jié)束時(shí)間，以及一個(gè)速度閾值，根據(jù)設(shè)定的定位開始時(shí)間和定位結(jié)束時(shí)間，獲取這一段時(shí)間的定位數(shù)據(jù)，定位數(shù)據(jù)包括定位時(shí)間、經(jīng)度、緯度、定位數(shù)據(jù)是否為有效點(diǎn)，將這些定位數(shù)據(jù)按照定位時(shí)間進(jìn)行排序并保存在定位數(shù)據(jù)列表中。

在步驟（2）中，在所述定位數(shù)據(jù)列表中，將相鄰的兩個(gè)定位點(diǎn)的經(jīng)緯度根據(jù)勾股定理計(jì)算兩點(diǎn)之間的距離，再根據(jù)這兩個(gè)定位點(diǎn)的定位時(shí)間以及上一步計(jì)算出的距離計(jì)算出車輛的行駛速度。

在步驟（3）中，把計(jì)算得到的車輛行駛速度與設(shè)定的速度閾值進(jìn)行比較，當(dāng)計(jì)算得到的車輛行駛速度比設(shè)定的速度閾值小時(shí)，則保留該兩個(gè)定位點(diǎn)，當(dāng)計(jì)算得到的車輛行駛速度比設(shè)定的速度閾值大時(shí)，則移除該兩個(gè)定位點(diǎn)，循環(huán)下一組相鄰定位數(shù)據(jù)的判定直到定位數(shù)據(jù)列表結(jié)束。

對(duì)過(guò)濾一遍的定位數(shù)據(jù)列表進(jìn)行再進(jìn)行一次過(guò)濾，直到新的定位數(shù)據(jù)列表沒有出現(xiàn)漂移定位點(diǎn)。

與現(xiàn)有技術(shù)相比，本發(fā)明最終得到的定位數(shù)據(jù)列表中的定位數(shù)據(jù)信息即為無(wú)漂移點(diǎn)的相對(duì)精確定位信息。

與現(xiàn)有技術(shù)相比，本發(fā)明最終得到的定位數(shù)據(jù)列表中的定位數(shù)據(jù)信息即為無(wú)漂移點(diǎn)的相對(duì)精確定位信息，可以實(shí)現(xiàn)降低北斗衛(wèi)星導(dǎo)航定位裝置定位漂移，提高定位數(shù)據(jù)的準(zhǔn)確度。

附圖說(shuō)明

下面結(jié)合附圖對(duì)本發(fā)明作進(jìn)一步的詳細(xì)說(shuō)明。

圖1是本發(fā)明的定位漂移處理方法流程圖。

具體實(shí)施方式

請(qǐng)參閱圖1，首先，設(shè)定處理定位漂移定位開始時(shí)間、結(jié)束時(shí)間以及速度閾值后，執(zhí)行步驟（S01）獲取這一段時(shí)間內(nèi)按照定位時(shí)間排序有效的定位數(shù)據(jù)信息，保存到列表中。

執(zhí)行步驟（S02）將定位列表有漂移點(diǎn)狀態(tài)標(biāo)識(shí)置為否，執(zhí)行步驟（S03）根據(jù)相鄰勾股定理計(jì)算相鄰兩點(diǎn)之間的距離，執(zhí)行步驟S04根據(jù)兩點(diǎn)間的距離、定位時(shí)間間隔計(jì)算相鄰定位點(diǎn)間車輛的行駛速度。執(zhí)行步驟S05判斷相鄰的兩定位點(diǎn)的速度是否比設(shè)定的速度閾值（100m/s）大，當(dāng)小于該速度閾值時(shí)則執(zhí)行步驟（S03），當(dāng)大于該速度閾值時(shí)則執(zhí)行步驟（S06）刪除這兩個(gè)定位點(diǎn)，然后執(zhí)行步驟（S07）修改定位列表有漂移點(diǎn)狀態(tài)標(biāo)識(shí)，并將其標(biāo)識(shí)為是。然后如上按順序執(zhí)行步驟（S03）→（S04）→（S05）→（S06）→（S07）處理下一組相鄰的定位點(diǎn)。

執(zhí)行步驟（S08）進(jìn)一步判斷定位列表有定位點(diǎn)漂移點(diǎn)標(biāo)識(shí)狀態(tài)，如果定位點(diǎn)漂移標(biāo)識(shí)狀態(tài)為是，則執(zhí)行步驟（S02），如果定位點(diǎn)漂移標(biāo)識(shí)狀態(tài)為否，則處理結(jié)果，得到過(guò)濾后的最終定位信息點(diǎn)。

通過(guò)上述降低北斗衛(wèi)星導(dǎo)航定位裝置定位漂移的方法，可以過(guò)濾明顯定位錯(cuò)誤的定位點(diǎn)，提高北斗衛(wèi)星導(dǎo)航定位裝置的精準(zhǔn)度，以達(dá)到降低北斗衛(wèi)星導(dǎo)航定位裝置定位漂移的目的。通過(guò)實(shí)際運(yùn)行檢驗(yàn)，結(jié)果準(zhǔn)確，運(yùn)行效果良好。