一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法
【技術(shù)領(lǐng)域】
[0001]本發(fā)明涉及所述機(jī)器人定位方法，特別涉及一種基于分體超聲波和射頻的跟隨機(jī)器人定位系統(tǒng)的技術(shù)領(lǐng)域。
【背景技術(shù)】
[0002]跟隨機(jī)器人是人機(jī)交互研究中的一個熱點(diǎn)問題，在所述機(jī)器人鄰域具有廣泛的應(yīng)用，例如廣闊無比的高爾夫球場上的球桿袋跟隨所述機(jī)器人、大商場的跟隨購物車、機(jī)場的行李重物跟隨所述機(jī)器人等。跟隨過程往往是在比較復(fù)雜的環(huán)境中進(jìn)行的，因此需要對跟隨的目標(biāo)進(jìn)行定位并且可以避開障礙物，實(shí)現(xiàn)跟隨指定目標(biāo)的功能。
[0003]目前已有的跟隨所述機(jī)器人的定位方法主要是利用安裝中所述機(jī)器人本體上的視覺系統(tǒng)采集目標(biāo)及周圍環(huán)境的信息，然后利用圖像處理的算法對目標(biāo)進(jìn)行定位，這種方法容易受環(huán)境中相似物體干擾，并且中所述機(jī)器人跟隨的過程中會出現(xiàn)靜態(tài)和動態(tài)障礙物，所述機(jī)器人必需具備避障功能，而目前的避障算法復(fù)雜度較高，有容易進(jìn)入局部最優(yōu)的缺陷。同時，利用視覺系統(tǒng)的跟隨所述機(jī)器人成本高，不能適應(yīng)大部分人的經(jīng)濟(jì)能力。

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

[0004]本發(fā)明所要解決的技術(shù)問題是提供一種精確定位的基于分體超聲波和射頻的跟隨機(jī)器人定位系統(tǒng)，為此，本發(fā)明采用以下技術(shù)方案:
一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法，所述機(jī)器人設(shè)有分體超聲結(jié)合射頻模塊，所述分體超聲結(jié)合射頻模塊包括接收端、發(fā)射端，所述發(fā)射端及接收端均由超聲波接收探頭、射頻模塊及微控制單元組成，所述分體超聲結(jié)合射頻模塊的發(fā)送端，所述定位方法包括以下步驟:
a)開啟所述發(fā)送端和所述接收端，所述發(fā)送端和所述接收端通過各自內(nèi)部的射頻模塊進(jìn)行時間校準(zhǔn)，將所述發(fā)送端和所述接收端時間進(jìn)行同步，使時間誤差控制在I微秒以下；
b)所述發(fā)送端和所述接收端時間同步后，所述發(fā)送端延時相同時間發(fā)送全向超聲波信號；
c)所述發(fā)送端和所述接收端時間同步后，所述接收端等待10us后開啟計(jì)時器，等待接受所述發(fā)射端發(fā)送的全向超聲波信號；由于所述接收端包括之間有間距的第一超聲波接收探頭和第二超聲波接收探頭，能分別接收到所述發(fā)射端發(fā)出的以聲速直線傳播過來的超聲波信號，因此信號到達(dá)兩個接收探頭的時間有差異；
當(dāng)接收完成后，根據(jù)，得出，所述發(fā)射端到第一超聲波接收探頭的距離為dl，所述發(fā)射端到第二超聲波接收探頭的距離d2，V表示聲速，t表示所述發(fā)送端的信號開始計(jì)時到第一超聲波接收探頭或第二超聲波接收探頭接受到的時間，由于第一超聲波接收探頭、第二超聲波接收探頭及發(fā)送端構(gòu)成的三角形三邊已知，即dl、d2及第一超聲波接收探頭和第二超聲波接收探頭的距離，可計(jì)算出被跟隨目標(biāo)的位置，即為三角定位計(jì)算方法;控制目標(biāo)的位置誤差在1cm以內(nèi)； d)所述接收端解算出目標(biāo)位置信息后能將數(shù)據(jù)發(fā)送給上位機(jī)如USART，SPI，IIC;
e)通過所述上位機(jī)估算出目標(biāo)的位置，實(shí)現(xiàn)機(jī)器人對被跟隨人的跟隨功能。
[0005]在采用上述技術(shù)方案的基礎(chǔ)上，本發(fā)明還可采用以下進(jìn)一步的技術(shù)方案:
所述分體超聲結(jié)合射頻的機(jī)器人定位方法能達(dá)到1Hz的定位頻率?？紤]到本模塊超聲波的信號強(qiáng)度，其最多能在空間中傳播20m并被檢測到，因此結(jié)合聲速340m/s其在空中的滯留時間是58.8ms。為防止回波干擾(上一次發(fā)送出去的超聲波信號還沒完全在空氣中衰減，新的信號又被發(fā)送)因此極限頻率是1/0.0588=17Hz。再加上單片機(jī)處理及等待的時間，于是將頻率定在1Hz。
[0006]所述分體超聲結(jié)合射頻模塊的發(fā)送端可替換為全向發(fā)射模塊，所述全向發(fā)射模塊包括一個射頻模塊以及不同方向的多個超聲波發(fā)射頭;其中全向發(fā)射模塊中的射頻模塊和所述接收端的射頻模塊是用來校準(zhǔn)兩個設(shè)備之間的時間，保證兩個模塊的時間誤差小于微秒。之后通過多個超聲波發(fā)射頭發(fā)射全向超聲波，由于是多個超聲波發(fā)射頭同時發(fā)送，保證發(fā)出的超聲波覆蓋空間全范圍，且由于超聲波發(fā)射頭安裝位置較為接近，因此可認(rèn)為超聲波送同一點(diǎn)發(fā)送出來。所述接收端接收到所述超聲波，并通過上位機(jī)計(jì)算出不同的距離，所述上位機(jī)再通過所述三角定位計(jì)算方法，估算出目標(biāo)的位置，使得目標(biāo)的精確位置的誤差控制在1cm以內(nèi)，進(jìn)而通過估算出目標(biāo)的位置實(shí)現(xiàn)機(jī)器人對被跟隨人的跟隨功能。
[0007]由于采用本發(fā)明的技術(shù)方案，本發(fā)明的有益效果為:本發(fā)明通過多三角定位方法，以及多個超聲波發(fā)射方便全方位無死角探測，精確的測得被跟隨人的具體位置，使機(jī)器人能夠?qū)崟r的跟隨人行進(jìn)。
【附圖說明】
圖1為本發(fā)明一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法示意圖。
其中A為發(fā)送端，B為，第一超聲波接收探頭，C為第二超聲波接收探頭。
【具體實(shí)施方式】
[0008]如圖所示，一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法，所述機(jī)器人設(shè)有分體超聲結(jié)合射頻模塊，所述分體超聲結(jié)合射頻模塊包括接收端、超聲波探頭，nrf24101射頻模塊，stm32f!03c8t6微控制單元，所述分體超聲結(jié)合射頻模塊的發(fā)送端，所述定位方法包括以下步驟:
a)開啟所述發(fā)送端和所述接收端，所述發(fā)送端和所述接收端通過各自內(nèi)部的射頻模塊進(jìn)行時間校準(zhǔn)，將所述發(fā)送端和所述接收端時間進(jìn)行同步，使時間誤差控制在I微秒以下；
b)所述發(fā)送端和所述接收端時間同步后，所述發(fā)送端延時10us發(fā)送全向超聲波信號；
c)所述發(fā)送端和所述接收端時間同步后，所述接收端等待10us后開啟計(jì)時器，等待接受所述發(fā)射端發(fā)送的全向超聲波信號；由于所述接收端包括之間有間距的第一超聲波接收探頭和第二超聲波接收探頭，兩個探頭一般之間設(shè)定間隔為I米，能分別接收到所述發(fā)射端發(fā)出的以聲速直線傳播過來的超聲波信號，因此信號到達(dá)兩個接收探頭的時間有差異；
當(dāng)接收完成后，根據(jù)，得出，所述發(fā)射端到第一超聲波接收探頭的距離為dl，所述發(fā)射端到第二超聲波接收探頭的距離d2，V表示聲速，t表示所述發(fā)送端的信號開始計(jì)時到第一超聲波接收探頭或第二超聲波接收探頭接受到的時間，由于第一超聲波接收探頭、第二超聲波接收探頭及發(fā)送端構(gòu)成的三角形三邊已知，即dl、d2及第一超聲波接收探頭和第二超聲波接收探頭的距離，可計(jì)算出被跟隨目標(biāo)的位置，即為三角定位計(jì)算方法;控制目標(biāo)的位置誤差在1cm以內(nèi)；
d)所述接收端解算出目標(biāo)位置信息后能將數(shù)據(jù)發(fā)送給上位機(jī)如USART，SPI，IIC;
e)通過所述上位機(jī)估算出目標(biāo)的位置，實(shí)現(xiàn)機(jī)器人對被跟隨人的跟隨功能。
[0009]所述分體超聲結(jié)合射頻模塊的發(fā)送端可替換為全向發(fā)射模塊，所述全向發(fā)射模塊包括一個射頻模塊以及不同方向的多個超聲波發(fā)射頭;其中全向發(fā)射模塊中的射頻模塊和所述接收端的射頻模塊是用來校準(zhǔn)兩個設(shè)備之間的時間，使之同步(誤差小于I微秒)，之后通過多個超聲波發(fā)射頭發(fā)射全向超聲波，所述接收端接收到所述超聲波，并通過上位機(jī)計(jì)算出不同的距離所述上位機(jī)再通過所述三角定位計(jì)算方法，估算出目標(biāo)的位置，使得目標(biāo)的精確位置的誤差控制在1cm以內(nèi)，進(jìn)而通過估算出目標(biāo)的位置實(shí)現(xiàn)機(jī)器人對被跟隨人的跟隨功能。
【主權(quán)項(xiàng)】
1.一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法，其特征在于，所述機(jī)器人設(shè)有分體超聲結(jié)合射頻模塊，所述分體超聲結(jié)合射頻模塊包括接收端、發(fā)射端，所述發(fā)射端及接收端均由超聲波接收探頭、射頻模塊及微控制單元組成，所述分體超聲結(jié)合射頻模塊的發(fā)送端，所述定位方法包括以下步驟: a)開啟所述發(fā)送端和所述接收端，所述發(fā)送端和所述接收端通過各自內(nèi)部的射頻模塊進(jìn)行時間校準(zhǔn)，將所述發(fā)送端和所述接收端時間進(jìn)行同步，使時間誤差控制在I微秒以下； b)所述發(fā)送端和所述接收端時間同步后，所述發(fā)送端延時相同時間發(fā)送全向超聲波信號； c)所述發(fā)送端和所述接收端時間同步后，所述接收端等待10us后開啟計(jì)時器，等待接受所述發(fā)射端發(fā)送的全向超聲波信號；由于所述接收端包括之間有間距的第一超聲波接收探頭和第二超聲波接收探頭，能分別接收到所述發(fā)射端發(fā)出的以聲速直線傳播過來的超聲波信號，因此信號到達(dá)兩個接收探頭的時間有差異； 當(dāng)接收完成后，根據(jù)，得出，所述發(fā)射端到第一超聲波接收探頭的距離為dl，所述發(fā)射端到第二超聲波接收探頭的距離d2，V表示聲速，t表示所述發(fā)送端的信號開始計(jì)時到第一超聲波接收探頭或第二超聲波接收探頭接受到的時間，由于第一超聲波接收探頭、第二超聲波接收探頭及發(fā)送端構(gòu)成的三角形三邊已知，即dl、d2及第一超聲波接收探頭和第二超聲波接收探頭的距離，可計(jì)算出被跟隨目標(biāo)的位置，即為三角定位計(jì)算方法;控制目標(biāo)的位置誤差在1cm以內(nèi)； d)所述接收端解算出目標(biāo)位置信息后能將數(shù)據(jù)發(fā)送給上位機(jī)； e)通過所述上位機(jī)估算出目標(biāo)的位置，實(shí)現(xiàn)機(jī)器人對被跟隨人的跟隨功能。2.如權(quán)利要求1所述的一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法，其特征在于，所述分體超聲結(jié)合射頻的機(jī)器人定位方法能達(dá)到I OHz的定位頻率。3.如權(quán)利要求1所述的一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法，其特征在于:所述分體超聲結(jié)合射頻模塊的發(fā)送端可替換為全向發(fā)射模塊，所述全向發(fā)射模塊包括一個射頻模塊以及不同方向的多個超聲波發(fā)射頭;其中全向發(fā)射模塊中的射頻模塊和所述接收端的射頻模塊是用來校準(zhǔn)兩個設(shè)備之間的時間，使之同步，誤差小于I微秒，之后通過多個超聲波發(fā)射頭發(fā)射全向超聲波，所述接收端接收到所述超聲波，并通過上位機(jī)計(jì)算出不同的距離所述上位機(jī)再通過所述三角定位計(jì)算方法，估算出目標(biāo)的位置，使得目標(biāo)的精確位置的誤差控制在1cm以內(nèi)，進(jìn)而通過估算出目標(biāo)的位置實(shí)現(xiàn)機(jī)器人對被跟隨人的跟隨功能。
【專利摘要】本發(fā)明所要解決的技術(shù)問題是提供了一種基于分體超聲結(jié)合射頻的機(jī)器人定位方法，所述機(jī)器人設(shè)有分體超聲結(jié)合射頻模塊，所述分體超聲結(jié)合射頻模塊包括接收端、發(fā)射端，所述發(fā)射端及接收端均由超聲波接收探頭、射頻模塊及微控制單元組成，所述分體超聲結(jié)合射頻模塊的發(fā)送端。本發(fā)明通過多三角定位方法，以及多個超聲波發(fā)射方便全方位無死角探測，精確的測得被跟隨人的具體位置，使機(jī)器人能夠?qū)崟r的跟隨人行進(jìn)。
【IPC分類】G01S7/524, G01S15/06
【公開號】CN105629241
【申請?zhí)枴緾N201510971902
【發(fā)明人】劉勇, 徐晉鴻
【申請人】浙江大學(xué)
【公開日】2016年6月1日
【申請日】2015年12月22日