一種行車軌跡的平滑方法

基本信息

申請(qǐng)?zhí)?/td> CN201410424307.4 申請(qǐng)日 -
公開(公告)號(hào) CN104215249A 公開(公告)日 2014-12-17
申請(qǐng)公布號(hào) CN104215249A 申請(qǐng)公布日 2014-12-17
分類號(hào) G01C21/26(2006.01)I 分類 測(cè)量;測(cè)試;
發(fā)明人 陳續(xù);莊川杰;林仁飛 申請(qǐng)(專利權(quán))人 廈門市潤(rùn)銘網(wǎng)絡(luò)科技有限公司
代理機(jī)構(gòu) 廈門市精誠(chéng)新創(chuàng)知識(shí)產(chǎn)權(quán)代理有限公司 代理人 李伊飏
地址 361000 福建省廈門市軟件園二期望海路39號(hào)401室
法律狀態(tài) -

摘要

摘要 本發(fā)明公開一種行車軌跡的平滑方法,包括如下過(guò)程:步驟1:以一定的采樣頻率獲取車輛的行駛坐標(biāo),作為原始定位坐標(biāo),記為{P1,…Pk,…,Pq},k=1,2,…,q;步驟2:對(duì)原始定位坐標(biāo){P1,…Pk,…,Pq}進(jìn)行篩選過(guò)濾,避免漂移的坐標(biāo)點(diǎn)帶來(lái)的影響;步驟3:對(duì)對(duì)經(jīng)過(guò)步驟2篩選過(guò)濾后的定位坐標(biāo)進(jìn)行拐點(diǎn)補(bǔ)償和插值;步驟4:根據(jù)步驟3獲得的定位坐標(biāo)進(jìn)行路徑擬合。本發(fā)明通過(guò)上述方法,該方法采用覆蓋底層到上層的優(yōu)化算法,在相同的坐標(biāo)采樣周期內(nèi),為用戶提供最優(yōu)的軌跡平滑及呈現(xiàn)方法。本發(fā)明結(jié)合定位漂移抑制算法以及拐點(diǎn)補(bǔ)償和插值算法,具有很好的平滑效果,同時(shí),其算法簡(jiǎn)單,易于實(shí)現(xiàn),具有很好的實(shí)用性。