一種多無人車協(xié)同導(dǎo)航定位方法及系統(tǒng)

基本信息

申請?zhí)?/td> CN201911172357.7 申請日 -
公開(公告)號 CN110824423B 公開(公告)日 2021-08-17
申請公布號 CN110824423B 申請公布日 2021-08-17
分類號 G01S5/02(2010.01)I 分類 測量;測試;
發(fā)明人 梁源;徐兵 申請(專利權(quán))人 北京壹?xì)淇萍加邢薰?/a>
代理機(jī)構(gòu) 北京高沃律師事務(wù)所 代理人 楊媛媛
地址 100020北京市朝陽區(qū)錦芳路1號院10號樓3層315
法律狀態(tài) -

摘要

摘要 本發(fā)明公開一種多無人車協(xié)同導(dǎo)航定位方法及系統(tǒng)。該方法包括:獲取周圍無人車發(fā)送的攜帶位置信息的藍(lán)牙信號;從藍(lán)牙信號中解析信號強(qiáng)度、來源角度和位置信息;來源角度為周圍無人車與當(dāng)前無人車的連線相對于當(dāng)前無人車的航向的偏轉(zhuǎn)角度;根據(jù)來源角度計(jì)算周圍無人車與當(dāng)前無人車的連線的偏轉(zhuǎn)角度,得到來源信號偏轉(zhuǎn)角;根據(jù)信號強(qiáng)度、來源信號偏轉(zhuǎn)角和位置信息,采用卡爾曼濾波算法對當(dāng)前無人車的位置進(jìn)行更新,得到定位結(jié)果。本發(fā)明的多無人車協(xié)同導(dǎo)航定位方法及系統(tǒng),能夠提高協(xié)同導(dǎo)航的精度。