本發(fā)明涉及自動化控制領(lǐng)域,特別涉及一種基于視覺傳感器智能自動跟隨的結(jié)構(gòu)。
背景技術(shù):
目前人們出行很不方便,需手提或推行李箱,因此本申請人設(shè)計(jì)了可驅(qū)動的一代智能行李箱。一代智能行李箱上設(shè)有供人踩踏的踏板及驅(qū)動行走輪,人站在踩踏上手扶行李箱拉桿,可操控行李箱行走。但是一代智能行李箱存在以下缺點(diǎn):不能自動跟隨,還需人工操控。
因此,本申請人申請了二代智能行李箱,二代智能行李箱主要采用基于手機(jī)藍(lán)牙基站的定位及導(dǎo)航,基本原理是利用RSSI即信號強(qiáng)度定位,獲取藍(lán)牙基站的距離信息,根據(jù)多個藍(lán)牙基站的距離信息就可以確定行李箱主人手機(jī)的位置。但是二代智能行李箱存在以下缺點(diǎn):定位精度受到外界電磁頻率影響較大,在人流量大電磁輻射較強(qiáng)的室外場合可能會出現(xiàn)較大定位誤差,需要配合超聲波紅外等傳感器使用。
因此,有必要研發(fā)一種識別精度高、避障效果好的智能自動跟隨行李箱。
技術(shù)實(shí)現(xiàn)要素:
有鑒于此,本發(fā)明的目的在于提供一種能提高識別精度高和避障效果的基于視覺傳感器智能自動跟隨方法。
本發(fā)明還提供一種能提高識別精度高和避障效果的基于視覺傳感器智能自動跟隨系統(tǒng)。
本發(fā)明還提供一種能提高識別精度高和避障效果的基于視覺傳感器智能自動跟隨行李箱。
為了達(dá)成上述目的,本發(fā)明的解決方案是:
基于視覺傳感器智能自動跟隨方法,通過主控制器實(shí)現(xiàn),主控制器包括視覺定位模塊、避障模塊、數(shù)據(jù)處理模塊、驅(qū)動模塊和PID控制器,主控制器如下實(shí)現(xiàn):
視覺定位模塊采集行李箱主人及行李箱的環(huán)境信息,經(jīng)分析獲取行李箱主人相對行李箱的位置信息并發(fā)送至數(shù)據(jù)處理模塊;
數(shù)據(jù)處理模塊收到位置信息后,建立以行李箱為原點(diǎn)的坐標(biāo)系,通過人體識別算法識別出行李箱主人,并得到行李箱主人相對行李箱的坐標(biāo)位置;
避障模塊獲取行李箱主人至行李箱周邊環(huán)境的避障信息,并發(fā)送至數(shù)據(jù)處理模塊;
數(shù)據(jù)處理模塊根據(jù)行李箱主人相對行李箱的坐標(biāo)位置、避障信息規(guī)劃線路;數(shù)據(jù)處理模塊根據(jù)規(guī)劃線路發(fā)送指令給驅(qū)動模塊,驅(qū)動模塊分別驅(qū)動行李箱的左后輪電機(jī)和右后輪電機(jī)運(yùn)轉(zhuǎn);數(shù)據(jù)處理模塊根據(jù)規(guī)劃線路發(fā)送指令給PID控制器,通過PID控制器使行李箱和行李箱主人之間的相對位置保持在設(shè)定范圍內(nèi);
主控制器使行李箱與行李箱主人如下保持同步:
主控制器根據(jù)當(dāng)前行李箱主人的步態(tài)、行走速度、行走方向和行走線路上的障礙物,預(yù)測行李箱主人下一步動作:行走速度、行走方向和行走線路;
主控制器根據(jù)行李箱主人相對行李箱的坐標(biāo)位置、避障信息以及預(yù)測信息,規(guī)劃線路,并計(jì)算轉(zhuǎn)向機(jī)構(gòu)調(diào)整行李箱左前輪和右前輪的轉(zhuǎn)向角度,以及左后輪電機(jī)和右后輪電機(jī)的轉(zhuǎn)速。
所述主控制器還包括超聲波定位模塊、無線定位模塊和藍(lán)牙定位模塊中的一種或多種,超聲波定位模塊、無線定位模塊和藍(lán)牙定位模塊分別采集環(huán)境信息,經(jīng)分析獲取行李箱主人相對行李箱的位置信息,并發(fā)送至所述數(shù)據(jù)處理模塊。
所述避障模塊包括視覺避障模塊、超聲波避障模塊、紅外避障模塊和無線避障模塊中的一種或多種合;所述避障模塊還采集行李箱主人至行李箱周邊環(huán)境上人流的行走線路趨勢,并發(fā)送至所述數(shù)據(jù)處理模塊;所述數(shù)據(jù)處理模塊根據(jù)行李箱主人的坐標(biāo)位置、行李箱的坐標(biāo)位置、避障信息、人流的行走線路趨勢規(guī)劃線路。
所述主控制器還包括報(bào)警模塊,報(bào)警模塊包括手機(jī)報(bào)警模塊、箱子開關(guān)報(bào)警模塊和輪子報(bào)警模塊;若行李箱與行李箱主人之間超過設(shè)定距離,或者行李箱丟失,則進(jìn)行如下報(bào)警:手機(jī)報(bào)警模塊向行李箱主人的手機(jī)發(fā)送報(bào)警信息;若行李箱開鎖或者打開,箱子開關(guān)報(bào)警模塊向行李箱主人的手機(jī)發(fā)送報(bào)警信息;輪子報(bào)警模塊使行李箱的輪子鎖死,無法旋轉(zhuǎn)。
基于視覺傳感器智能自動跟隨系統(tǒng),該系統(tǒng)為如前所述方法采用的系統(tǒng)。
基于視覺傳感器智能自動跟隨行李箱,包括箱體、行走機(jī)構(gòu)、驅(qū)動電機(jī)、轉(zhuǎn)向機(jī)構(gòu)和電源;行走機(jī)構(gòu)包括設(shè)置于箱體外表面上的左前輪、右前輪、左后輪和右后輪;驅(qū)動電機(jī)包括左后輪電機(jī)和右后輪電機(jī);
還包括基于視覺傳感器智能自動跟隨系統(tǒng),該系統(tǒng)包括主控制器,主控制器包括視覺定位模塊、避障模塊、數(shù)據(jù)處理模塊、驅(qū)動模塊和PID控制器;
視覺定位模塊采集行李箱主人及行李箱的環(huán)境信息,經(jīng)分析獲取行李箱主人相對行李箱的位置信息并發(fā)送至數(shù)據(jù)處理模塊;
數(shù)據(jù)處理模塊收到位置信息后,建立以行李箱為原點(diǎn)的坐標(biāo)系,通過人體識別算法識別出行李箱主人,并得到行李箱主人相對行李箱的坐標(biāo)位置;
避障模塊獲取行李箱主人至行李箱周邊環(huán)境的避障信息,并發(fā)送至數(shù)據(jù)處理模塊;
數(shù)據(jù)處理模塊根據(jù)行李箱主人相對行李箱的坐標(biāo)位置、避障信息規(guī)劃線路;數(shù)據(jù)處理模塊根據(jù)規(guī)劃線路發(fā)送指令給驅(qū)動模塊,驅(qū)動模塊分別驅(qū)動行李箱的左后輪電機(jī)和右后輪電機(jī)運(yùn)轉(zhuǎn);數(shù)據(jù)處理模塊根據(jù)規(guī)劃線路發(fā)送指令給PID控制器,通過PID控制器使行李箱和行李箱主人之間的相對位置保持在設(shè)定范圍內(nèi);
主控制器使行李箱與行李箱主人如下保持同步:
主控制器根據(jù)當(dāng)前行李箱主人的步態(tài)、行走速度、行走方向和行走線路上的障礙物,預(yù)測行李箱主人下一步動作:行走速度、行走方向和行走線路;
主控制器根據(jù)行李箱主人相對行李箱的坐標(biāo)位置、避障信息以及預(yù)測信息,規(guī)劃線路,并計(jì)算轉(zhuǎn)向機(jī)構(gòu)調(diào)整行李箱左前輪和右前輪的轉(zhuǎn)向角度,以及左后輪電機(jī)和右后輪電機(jī)的轉(zhuǎn)速;
電源向驅(qū)動電機(jī)、轉(zhuǎn)向機(jī)構(gòu)和所述系統(tǒng)提供電源。
采用上述方案后,本發(fā)明具有以下有益效果:可以直接利用視覺傳感器得到的深度信息來判斷障礙物的位置,然后使用人工勢場法來進(jìn)行避障,而且識別精度高,避障效果好,不易受外部環(huán)境干擾。特別是結(jié)合超聲波避障模塊,還可進(jìn)一步提高識別精度、避障效果。
附圖說明
圖1為本發(fā)明的框圖。
具體實(shí)施方式
為了進(jìn)一步解釋本發(fā)明的技術(shù)方案,下面通過具體實(shí)施例來對本發(fā)明進(jìn)行詳細(xì)闡述。
實(shí)施例一
本實(shí)施例為具體應(yīng)用到行李箱的一個示例。本實(shí)施例中,基于視覺傳感器智能自動跟隨行李箱,簡稱智能自動跟隨行李箱,其主要包括:箱體、行走機(jī)構(gòu)、驅(qū)動電機(jī)、轉(zhuǎn)向機(jī)構(gòu)、電源和跟隨系統(tǒng)。這里的跟隨系統(tǒng)是基于視覺傳感器智能自動跟隨系統(tǒng)的簡稱。
行走機(jī)構(gòu)包括設(shè)置于箱體外表面上的多個輪子,多個輪子分別為左前輪、右前輪、左后輪和右后輪。左前輪、右前輪、左后輪和右后輪可分別采用萬向輪,左后輪和右后輪為行李箱提供動力,左前輪、右前輪一方面減后輪驅(qū)動的承載壓力,一方面能使行李箱的轉(zhuǎn)向更為靈活。
驅(qū)動電機(jī)包括左后輪電機(jī)和右后輪電機(jī)。
電源向驅(qū)動電機(jī)、轉(zhuǎn)向機(jī)構(gòu)和跟隨系統(tǒng)提供電源。
跟隨系統(tǒng)主要包括主控制器,主控制器包括定位模塊、避障模塊、數(shù)據(jù)處理模塊、驅(qū)動模塊和PID控制器。
定位模塊可采用視覺定位模塊、超聲波定位模塊、無線定位模塊和藍(lán)牙定位模塊等中的一種定位模塊或多種定位模塊。定位模塊主要是確定行李箱主人相對行李箱的方位、距離、角度、高度、輪廓、外部特征等位置信息。其中,視覺定位模塊主要包括視覺傳感器和視覺數(shù)據(jù)處理模塊。無線定位模塊以能拆卸的方式設(shè)置。無線定位模塊包括行李箱主人攜帶的定位標(biāo)簽,以及設(shè)置在行李箱上作為基站的傳感器。定位標(biāo)簽和傳感器之間進(jìn)行數(shù)據(jù)傳輸,以確定行李箱主人相對行李箱的位置。
較佳地,定位模塊中以不易受環(huán)境干擾的定位模塊為主定位模塊,其他定位模塊為輔定位模塊??梢砸曈X定位模塊為主定位模塊,其他的超聲波定位模塊、無線定位模塊和藍(lán)牙定位模塊為輔定位模塊。
較佳地,主控制器還包括報(bào)警模塊。報(bào)警模塊主要包括手機(jī)報(bào)警模塊、箱子開關(guān)報(bào)警模塊、輪子報(bào)警模塊。若行李箱丟失,手機(jī)報(bào)警模塊向行李箱主人的手機(jī)發(fā)送報(bào)警信息;行李箱一旦打開,箱子開關(guān)報(bào)警模塊向行李箱主人的手機(jī)發(fā)送報(bào)警信息;輪子報(bào)警模塊使行李箱的輪子鎖死,無法旋轉(zhuǎn)。其中本系統(tǒng)可包括手機(jī)報(bào)警模塊、箱子開關(guān)報(bào)警模塊、輪子報(bào)警模塊中的任一種報(bào)警模塊或兩種以上報(bào)警模塊。其中,行李箱主人的手機(jī)還可替換成任一電子終端,例如智能手表、智能手環(huán)、IPAD等。
如圖1所示,本實(shí)施例中,基于視覺傳感器智能自動跟隨方法主要如下實(shí)現(xiàn):
視覺傳感器將采集到的行李箱主人及行李箱周邊的環(huán)境信息發(fā)送至視覺數(shù)據(jù)處理模塊。視覺數(shù)據(jù)處理模塊經(jīng)分析、處理后獲取行李箱主人相對行李箱的位置信息,并發(fā)送至數(shù)據(jù)處理模塊。
其中,環(huán)境信息包括障礙物、障礙物的位置、方位及距離等。行李箱主人周邊環(huán)境、行李箱周邊環(huán)境可以設(shè)定在一個合理的范圍內(nèi)。例如:周邊環(huán)境分別以行李箱主人、行李箱為圓心,半徑為1米、1.5米、2米或若干米的范圍,視覺傳感器獲取該范圍內(nèi)周邊環(huán)境信息。后面提及的規(guī)劃線路、避障線路的周邊環(huán)境也可如上設(shè)定。
較佳地,超聲波定位模塊、無線定位模塊也將各自采集的周邊環(huán)境信息經(jīng)分析獲取行李箱主人相對行李箱的位置信息,并發(fā)送至數(shù)據(jù)處理模塊。
數(shù)據(jù)處理模塊收到位置信息之后,建立以行李箱為原點(diǎn)的坐標(biāo)系。數(shù)據(jù)處理模塊通過人體識別算法識別出行李箱主人,并得到行李箱主人相對行李箱的坐標(biāo)位置。通過視覺定位模塊、超聲波定位模塊、無線定位模塊這些定位模塊可提高兩者之間相對位置的定位精度,降低、甚至減少周圍環(huán)境對定位的影響。
避障模塊主要獲取行李箱主人至行李箱周邊環(huán)境的避障信息,并發(fā)送至數(shù)據(jù)處理模塊。其中避障模塊可采用視覺避障模塊、超聲波避障模塊、紅外避障模塊、無線避障模塊等中的一種或多種方式的組合。紅外避障模塊主要包括紅外傳感器。紅外傳感器包括紅外發(fā)射器、紅外接收器。其中,主動式紅外傳感器自帶紅外光源,通過對光源的遮擋、反射、折射等光學(xué)手段判別被探測物體位置。較佳地,選用反射型主動式紅外發(fā)射器、紅外接收器。
較佳地,避障模塊中以不易受環(huán)境干擾的避障模塊為主避障模塊,其他避障模塊為輔避障模塊??梢砸曈X避障模塊為主避障模塊,其他的超聲波避障模塊、紅外避障模塊、無線避障模塊為輔避障模塊。
該周邊環(huán)境的避障信息包括:從行李箱主人至行李箱之間的線路上周邊環(huán)境的避障物、行李箱主人周邊環(huán)境上的避障物、行李箱周邊環(huán)境上的避障物。周邊環(huán)境可如前所述進(jìn)行設(shè)定,例如,以行李箱主人至行李箱之間的連線上的每一點(diǎn)為圓心,1米為半徑設(shè)定為周邊環(huán)境的范圍。
數(shù)據(jù)處理模塊根據(jù)行李箱主人相對行李箱的坐標(biāo)位置、避障信息規(guī)劃線路。較佳地,避障模塊還采集行李箱主人至行李箱周邊環(huán)境上人流的行走線路趨勢,并發(fā)送至數(shù)據(jù)處理模塊。數(shù)據(jù)處理模塊規(guī)劃線路時根據(jù)行李箱主人的坐標(biāo)位置、行李箱的坐標(biāo)位置、避障信息、人流的行走線路趨勢,規(guī)劃出一條最佳的安全線路。
數(shù)據(jù)處理模塊根據(jù)規(guī)劃線路發(fā)送指令給驅(qū)動模塊,驅(qū)動模塊分別驅(qū)動行李箱的左后輪電機(jī)和右后輪電機(jī)運(yùn)轉(zhuǎn);數(shù)據(jù)處理模塊發(fā)送指令給PID控制器,通過PID控制器使行李箱和行李箱主人之間的相對位置保持在設(shè)定范圍內(nèi)。
其中,主控制器使行李箱與行李箱主人如下保持同步:
主控制器根據(jù)當(dāng)前行李箱主人的步態(tài)、行走速度、行走方向和行走線路上的障礙物,預(yù)測行李箱主人下一步動作:行走速度、行走方向和行走線路。
主控制器根據(jù)預(yù)測信息,以及超聲波避障模塊獲取的避障信息,規(guī)劃行李箱的避障線路,并計(jì)算轉(zhuǎn)向機(jī)構(gòu)調(diào)整行李箱左前輪和右前輪的轉(zhuǎn)向角度,以及左后輪電機(jī)和右后輪電機(jī)的轉(zhuǎn)速。
較佳地,驅(qū)動模塊接受主控制的速度指令,并將左輪子和右輪子的速度信息反饋給主控制器;主控制器通過藍(lán)牙通信和行李箱主人手機(jī)實(shí)現(xiàn)通訊;通過行李箱主人手機(jī)上的App可控制行李箱運(yùn)動,并監(jiān)測行李箱各模塊的運(yùn)行狀態(tài)。
本發(fā)明的定位方法、跟隨方法、避障方法如下:
1、數(shù)據(jù)處理模塊接收視覺定位模塊、超聲波定位模塊、無線定位模塊、藍(lán)牙定位模塊、避障模塊的信息,以行李箱為坐標(biāo)原點(diǎn)建立坐標(biāo)系,并確定行李箱主人相對于行李箱的坐標(biāo)位置。
2、數(shù)據(jù)處理模塊通過現(xiàn)有的算法確定周圍環(huán)境的障礙物相對行李箱的分布位置,即各障礙物的坐標(biāo)位置。
較佳地,定位模塊和避障模塊的傳感器設(shè)置在行李箱的箱體的前后左右外表面上,傳感器的接收端、發(fā)射端還可設(shè)置成旋轉(zhuǎn)式,這樣可采集行李箱周邊360度的環(huán)境信息。
而且還可設(shè)置一個地面檢測模塊,地面檢測模塊采集規(guī)劃線路上的地面平坦情況并發(fā)送至數(shù)據(jù)處理模塊,數(shù)據(jù)處理模塊以較為平坦的路面優(yōu)先規(guī)劃線路。同時,在行李箱的底部設(shè)置各類由彈簧、橡膠等構(gòu)成的吸震機(jī)構(gòu)、減震機(jī)構(gòu)。若地面檢測模塊檢測到地面有凹凸、不平坦,則數(shù)據(jù)處理模塊向驅(qū)動模塊發(fā)出減速的指令,驅(qū)動模塊控制驅(qū)動電機(jī)減速,或者控制轉(zhuǎn)向機(jī)構(gòu),使李箱左前輪和右前輪轉(zhuǎn)向繞開凹凸、不平坦的地面。
3、數(shù)據(jù)處理模塊線路規(guī)劃模塊根據(jù)目標(biāo)位置與周圍環(huán)境信息規(guī)劃一條無碰路徑,實(shí)現(xiàn)行李箱實(shí)時跟隨、避障。
4、行李箱可通過主控制器綁定行李箱主人的手機(jī),并設(shè)定修改、增減手機(jī)號的權(quán)限。當(dāng)行李箱主人與行李箱之間距離超過設(shè)定距離時,向行李箱主人的手機(jī)發(fā)出報(bào)警信息。
較佳地,行李箱的自主跟隨避障還可將跟隨模式設(shè)置成自動跟隨模式、手動跟隨模式。當(dāng)設(shè)置成手動跟隨模式,行李箱主人可通過手機(jī)實(shí)現(xiàn)操控:在手機(jī)上安裝行李箱操控App、用戶端等,通過手在手機(jī)觸摸屏上的觸摸動作的方向、快慢可操控行李箱進(jìn)、退、轉(zhuǎn)向、加減速。當(dāng)然,也可手握手機(jī),通過擺動手機(jī)的擺動方向、擺動快慢可操控行李箱進(jìn)、退、轉(zhuǎn)向、加減速。
較佳地,若行李箱與行李箱主人之間的相對距離超過設(shè)定值、丟失,則進(jìn)行如下報(bào)警:
1、李箱與行李箱主人之間的相對距離超過設(shè)定值,報(bào)警模塊向行李箱主人的手機(jī)發(fā)送報(bào)警信息,一類是短信、微信,一類是手機(jī)振動,通過多種方式提醒行李箱主人。
2、行李箱一旦開鎖、或開箱,箱子開關(guān)報(bào)警模塊向行李箱主人的手機(jī)以短信、微信、振動方式發(fā)送報(bào)警信息。
3、輪子報(bào)警模塊使行李箱的輪子鎖死,無法旋轉(zhuǎn),這樣行李箱就無法在地面上拖行,增加他人強(qiáng)行拖走行李箱的難度。
較佳地,行李箱主人辦理登機(jī)、通關(guān)、托運(yùn),則可將跟隨模式對應(yīng)設(shè)置成登機(jī)模式、通關(guān)模式、托運(yùn)模式。
而且登機(jī)模式與行李箱主人的航班的起落、延機(jī)等情形相關(guān)聯(lián),這樣當(dāng)報(bào)警模塊接收到航班的起落、延機(jī)等信息,在航班起飛直至落地期間,報(bào)警模塊就會自動相應(yīng)關(guān)閉,這樣報(bào)警模塊就不會在上述情形下發(fā)出誤報(bào)警信息。
通關(guān)模式與行李箱主人的通關(guān)、安檢情形相關(guān)聯(lián),這樣當(dāng)報(bào)警模塊接收到通關(guān)、安檢等信息,在此期間,報(bào)警模塊就會自動相應(yīng)關(guān)閉,這樣報(bào)警模塊就不會在上述情形下發(fā)出誤報(bào)警信息。
托運(yùn)模式與行李箱主人的托運(yùn)情形相關(guān)聯(lián),這樣當(dāng)報(bào)警模塊接收到托運(yùn)等信息,在此期間,報(bào)警模塊就會自動相應(yīng)關(guān)閉,這樣報(bào)警模塊就不會在上述情形下發(fā)出誤報(bào)警信息。
較佳地,避障模塊檢測到進(jìn)入登機(jī)、通關(guān)、托運(yùn)等待區(qū)域內(nèi),則向行李箱主人發(fā)送查詢信息,并根據(jù)行李箱主人的指令確定在跟隨模式、自動跟隨模式、手動跟隨模式、登機(jī)模式、通關(guān)模式、托運(yùn)模式等各種模式之間進(jìn)行自動或手動切換。
實(shí)施例二
本實(shí)施例中,視覺傳感器可采用深度視覺傳感器,作為行李箱的“眼睛”感知行李箱主人相對行李箱的位置。
視覺傳感器可采用華碩Xtion Pro Live,通過USB接口接到主控制器,主控制器得到Xtion Pro Live的數(shù)據(jù)之后通過人體識別算法識別出行李箱主人,并得到行李箱主人相對行李箱的位置。
得到行李箱主人相對行李箱的位置之后,主控制器發(fā)送指令給驅(qū)動模塊,驅(qū)動模塊驅(qū)動左輪電機(jī)、右輪電機(jī)運(yùn)轉(zhuǎn),通過PID控制器使行李箱和行李箱主人之間的相對位置保持在一個合理的設(shè)定范圍內(nèi)。
主控制器使用USB 5V電壓供電,電池為24V-12000mAh鋰電池,通過電池管理系統(tǒng)自動檢測電池的電量,電量不足時自動報(bào)警。驅(qū)動模塊供電電壓為24V,通過can總線和主控制器通信,接受主控制器的速度指令并將左后輪子、右后輪的速度信息反饋給主控制器。主控制器通過藍(lán)牙通信實(shí)現(xiàn)和行李箱主人手機(jī)的通訊。較佳地,通過手機(jī)App控制行李箱運(yùn)動,并監(jiān)測行李箱各模塊的運(yùn)行狀態(tài)。
較佳地,通過多路超聲波模塊實(shí)現(xiàn)行李箱移動過程中的避障。在行李箱的前面、兩個側(cè)面分別設(shè)置多個超聲波傳感器,超聲波傳感器的輸出端連接超聲波避障模塊的輸入端,超聲波避障模塊的輸出端連接主控制器的對應(yīng)輸入端。
實(shí)施例三
本發(fā)明可除了適用于行李箱外,還可適用于以下多種設(shè)備,例如:
1、基于視覺傳感器智能自動跟隨文具用品:基于視覺傳感器智能自動跟隨書包等。
2、基于視覺傳感器智能自動跟隨家居生活用品:嬰兒車、玩具、桌子、椅子、輪椅、購物車、機(jī)場行李車、寵物機(jī)器人、清掃機(jī)器人、護(hù)理機(jī)器人、服務(wù)機(jī)器人、箱包等。
3、基于視覺傳感器智能自動跟隨辦公用品:基于視覺傳感器智能自動跟隨運(yùn)輸工具等。
4、基于視覺傳感器智能自動跟隨健身用品。
5、基于視覺傳感器智能自動跟隨家居辦公用品。
當(dāng)本發(fā)明適用上述設(shè)備時,上述設(shè)備可相應(yīng)地自動跟隨,具體情形與前述實(shí)施例類似,具體如下所述:
視覺定位模塊采集設(shè)備主人及設(shè)備的環(huán)境信息,經(jīng)分析獲取設(shè)備主人相對設(shè)備的相對位置信息并發(fā)送至數(shù)據(jù)處理模塊。
數(shù)據(jù)處理模塊收到相對位置信息后,建立以設(shè)備為原點(diǎn)的坐標(biāo)系,通過人體識別算法識別出設(shè)備主人,并得到設(shè)備主人相對設(shè)備的坐標(biāo)位置。
避障模塊獲取設(shè)備主人至設(shè)備的周邊環(huán)境的避障信息,并發(fā)送至數(shù)據(jù)處理模塊。
數(shù)據(jù)處理模塊根據(jù)設(shè)備主人相對設(shè)備的坐標(biāo)位置、避障信息規(guī)劃線路。數(shù)據(jù)處理模塊根據(jù)規(guī)劃線路發(fā)送指令給驅(qū)動模塊,驅(qū)動模塊分別驅(qū)動設(shè)備的一個或多個行走輪驅(qū)動電機(jī)運(yùn)轉(zhuǎn)。數(shù)據(jù)處理模塊發(fā)送指令給PID控制器,通過PID控制器使設(shè)備和設(shè)備主人之間的相對位置保持在設(shè)定范圍內(nèi)。
主控制器使設(shè)備與設(shè)備主人如下保持同步:
主控制器根據(jù)當(dāng)前設(shè)備主人的步態(tài)、行走速度、行走方向和行走線路上的障礙物,預(yù)測設(shè)備主人下一步動作:行走速度、行走方向和行走線路。
主控制器根據(jù)預(yù)測信息以及避障信息,規(guī)劃設(shè)備的避障線路,并計(jì)算轉(zhuǎn)向機(jī)構(gòu)調(diào)整設(shè)備一個或多個行走輪的轉(zhuǎn)向角度,以及行走輪驅(qū)動電機(jī)的轉(zhuǎn)速。
本實(shí)施例還可采用上述實(shí)施例中的具體結(jié)構(gòu)、測距方法、定位方法、避障方法、跟隨方法等,相同之處,在此不再贅述。
上述實(shí)施例和附圖并非限定本發(fā)明的產(chǎn)品形態(tài)和式樣,任何所屬技術(shù)領(lǐng)域的普通技術(shù)人員對其所做的適當(dāng)變化或修飾,皆應(yīng)視為不脫離本發(fā)明的專利范疇。