本發(fā)明涉及無人駕駛運動小車,運動機器人運行路徑導引領域,尤其涉及倉儲搬運機器人運行路徑自動導引系統(tǒng)。
背景技術:
隨著社會的快速發(fā)展,大量貨物品種的陸續(xù)推向市場,不管是大型公司的倉庫庫房管理,還是電商平臺的物流倉儲的貨物管理,都面臨貨物出入庫搬運問題。搬運機器人(簡稱agv,automatedguideedvehicle)廣泛運用于工業(yè)、交通運輸,倉庫管理等領域,現(xiàn)有市面上的搬運機器人裝備有電磁或光學等自動導引裝置,能夠沿規(guī)定的導引路徑行駛。
目前用于agv導引技術主要有以下幾種方式,這些方式或多或少都存在一些不足。1)直接坐標方式,該方法通過用定位塊將待行駛區(qū)域分成若干坐標小區(qū)域,通過對小區(qū)域的計數(shù)實現(xiàn)導引。該導航方式地面測量安裝復雜,工作量大,導引精度及定位精度較低,無法滿足復雜路徑的要求。2)電磁導引方式,該方法是在行駛路徑上埋設金屬線,并在金屬線上加載導引頻率,通過導引頻率的識別來實現(xiàn)agv的導引。該導航方式的導航路徑難以更改擴展,對復雜路徑的局限性大。3)磁帶或磁釘導引方式,該方法是在路面上貼磁帶或磁釘?shù)却判栽娲孛嫦侣裨O金屬線,通過磁感應信號實現(xiàn)導航。磁帶或磁釘導航方式易受路徑周圍金屬物質的干擾,而且易受打掃衛(wèi)生或碰撞帶來的機械損傷。4)慣性導引方式,該方式是在運動小車上安裝陀螺儀,在行駛區(qū)域的地面上安裝定位塊,小車可通過對陀螺儀偏差信號(角速度)的計算及地面定位塊信號的采集來確定自身的位置及航行,從而實現(xiàn)導引。該導引方式制造成本較高,導引精度和可靠性與陀螺儀的精度及相關算法密切相關。5)機器視覺導引方式,該方式通過視覺傳感器(ccd)將目標轉換成圖像信號,然后通過對這些信號進行各種運算來提取目標特征,進而根據(jù)判別的結果來控制小車的運動。視覺導引主要有兩個研究方向,一是完全意義上的視覺技術,可模擬人的視覺原理來識別道路;二是通過標識線來進行視覺導引,譬如在灰色地板上將行走路徑鋪設黑色條狀路徑。該導引方式是圖像處理算法較為復雜,地面鋪設的標識線容易磨損從而引起錯誤識別。6)反射式激光導引方式,該方式通過在小車上安裝激光掃描雷達,掃描行駛路徑周圍安裝的精確位置的激光反射板,運動小車通過激光掃描雷達發(fā)射激光束,同時采集由反射板發(fā)射的激光束,來確定其當前位置并進行導航,該導引方式需要在待行駛路徑周圍預先設置好一系列反光板,成本較高。
上述的多種導引方式均有一個不方便使用的共同點,先規(guī)劃好路徑,不便對路徑進行靈活變更,本發(fā)明所提的智能光學導引系統(tǒng),克服上述在固定路徑做相關處理的方法,對路徑沒有任何改造的動作,而且可隨時依據(jù)路況靈活調整路徑。
針對agv小車的導引方案,專利cn1263625c提出一種光學制導式自動導引車導引裝置,該專利結合上面所述的方法4與6,需要預先架設激光發(fā)射板,專利cn103019240b提出利用超聲波傳感器感測預設路徑周圍的距離信息,并預存在數(shù)據(jù)庫中,為后續(xù)小車行進提供路徑修正信息,該方法雖然沒有在預定路徑架設輔助設備,可針對路徑中突然出現(xiàn)的物體,譬如人員走動等,將會產生錯誤的判斷。本發(fā)明提出的智能光學導引系統(tǒng),不需在預設路徑架設輔助設備,而且不易受環(huán)境變化干擾,很容易大力推廣實現(xiàn)。
技術實現(xiàn)要素:
本發(fā)明要解決的技術問題在于提供一種應用于無人駕駛的運動小車或運動機器人的智能光學導引系統(tǒng),能解決運動小車或機器人自動運動路徑控制問題,能廣泛應用在大型倉庫agv小車路徑管理應用領域,餐廳、醫(yī)療機構,居家等場所服務型機器人路徑管理應用領域,也可用于玩具車運動控制應用領域。
為了解決運動小車或機器人自動運動路徑控制問題問題,本發(fā)明采用如下技術方案:
提供一種智能光學導引系統(tǒng),包括用于導引的發(fā)光單元、安裝在運動小車或機器人上用于探測發(fā)光單元特定波長反射光的探測信號處理單元、可多方位運動平臺單元、控制單元:
所述用于導引的發(fā)光單元,可以采用激光(ld)光源,也可采用led光源,也可采用其他燈泡式光源,用于導引的發(fā)光單元采用光束準直技術,依據(jù)實際應用場合調整光束形狀及尺寸大小。
所述探測信號處理單元采用視覺傳感器(譬如ccd)或四象限光電探測傳感器,在傳感器前端安裝與發(fā)光單元一致的濾波片,通過判斷反射光點運動方向,實時調整運動小車或機器人的運動路徑。
所述可多方位運動平臺單元至少包含一個電動控制運動平臺,導引光源安裝在該平臺上。
所述控制單元,包括手持終端對定位系統(tǒng)的控制或pc計算機端對定位系統(tǒng)的控制,通過有線或無線通訊方式,實現(xiàn)對多方位運動平臺的任意控制,確保導引光源能準確引導小車或機器人的運動路徑。
本發(fā)明提供的智能光學導引裝置還包括如下技術特征:
所述智能光學導引系統(tǒng)發(fā)光光源可以是持續(xù)發(fā)光或以特定頻率發(fā)光,在需要控制的運動小車或機器人數(shù)量不多的情況,譬如在探測器視場中只有一個反射光點情形,可采用持續(xù)發(fā)光方式;若需要導引物體較多,安裝在運動小車或機器人探測器視場存在多個反射光點情形,需要通過發(fā)光的不同頻率予以區(qū)分。
所述發(fā)光光源的光點圖案可以是點光源,十字圖案光源,圓形或方形等圖案光源。
所述多方位運動平臺具有坐標原點定位修正功能,能確保運動平臺經過多次運動后,能及時返回原點進行坐標修正。
所述多方位運動平臺可通過手持終端采用有線或無線通訊方式進行遠程控制,其中有線方式可采用rs485/rs422總線方式,can總線等方式進行組網通訊;無線方式可采用zigbee,antplus,ble,lora,wifi等方式進行組網通訊。
所述智能光學定位系統(tǒng)的手持終端可用于手動調試導引光源,并對運動小車或機器人進行導引測試。
本發(fā)明還采用如下技術方案:
一種智能光學導引方法,以導引倉庫或車間agv小車為例,所述方法包括以下步驟:
1,依據(jù)agv小車運行路徑選定需要安裝的導引光源裝置數(shù)量,導引光源可安裝在房間頂部或貨架上方,盡可能避免運動物體阻擋光源,因agv小車載物后有一定高度,所以需采用前向導引方法及接力棒方式依次導引,當agv下車抵達某一導引光源正下方后,將切換至下一導引光源進行前向導引;
2,對導引光源裝置進行編號,并可進行仿真模擬,指定起點及終點后,會自動生成需要調用的不同編號的導引光源裝置,并有對應的導引優(yōu)先次序。
3,運動agv小車裝有反射光點探測器及速度傳感器,當導引光源發(fā)出導引光在前方做導引時,agv車上的發(fā)射光點探測器會探測導引光源照射地面的發(fā)射光點,因采用濾波片技術,很好地消除周圍環(huán)境光的干擾,反射光點探測器依據(jù)探測信號采用相關算法判定導引光的運動方向,實時調整agv小車的運行軌跡,同時會實時將小車運動速度發(fā)送給對應導引光源,形成閉環(huán)控制,當小車遇到人或其他障礙物時,小車會停止,導引光源收到信息后也會停止運動,在一段時間后障礙物仍沒消除,采用語音提示避讓,若仍沒消除,導引光源會導引小車偏轉一定角度繼續(xù)前進。
4,當導引光源將agv小車導引至與導引光源裝置在相同垂直平面后,對下一編號導引光源裝置發(fā)出切換導引指令,下一導引光源裝置收到指令后打開導引光源,同時上一導引光源關閉導引光源。
5,后臺軟件可依據(jù)各編號導引光源的運行狀況及導引光源方位角實時再現(xiàn)各被導引agv小車的實際位置。
本發(fā)明提出的智能光學導引系統(tǒng),充分結合了物聯(lián)網節(jié)點組網技術、多軸運動控制技術、光學準直定位技術,光點追蹤技術開創(chuàng)性地解決了無人駕駛運動小車或機器人運動路徑導引問題。
與現(xiàn)有agv小車導引系統(tǒng)采取的rfid或激光雷達技術相比,本發(fā)明的有益技術效果是:1、極大減少類似目前磁條導引方式的對路面的路徑鋪設的改造;2、不必擔心對地面做衛(wèi)生而影響導引信息采集;3、非常方便后續(xù)設備維護,只需確保導引光源及光學探測單元正常工作,路徑擴容很容易調試及實現(xiàn)。
附圖說明
為了更清楚地說明本發(fā)明實施例中的技術方案,下面對所需的附圖做簡單介紹,顯而易見地,下面描述中的附圖僅僅是本發(fā)明的一些實施例,對于本領域普通技術人員而言,在不付出創(chuàng)造性勞動的前提下,還可根據(jù)這些附圖獲得其他的附圖。
圖1是本發(fā)明提供的一種智能光學導引系統(tǒng)示意圖;
圖2是本發(fā)明所提出的導引裝置及被導引裝置的結構示意框圖;
圖3是本發(fā)明在庫房或車間agv小車導引的示意圖;
圖4是本發(fā)明應用在單主干道導引路線示意圖;
圖5是本發(fā)明應用在多主干道導引路線示意圖。
具體實施方式
下面結合附圖及最佳實施例,對本發(fā)明做進一步詳細說明。
本發(fā)明所提出的智能光學導引系統(tǒng),主要用于無人駕駛運動小車,運動機器人運行路徑導引領域,尤其涉及倉儲搬運機器人運行路徑自動導引系統(tǒng)。
圖1示出了本發(fā)明提供的一種智能光學導引系統(tǒng)示意圖。1為被導引小車或機器人,2為反射光點探測單元,3為安置在運動電控平臺上的導引光源,4為導引光束,5為反射光束,6為導引光束照射地面的光點,7為光點探測單元探測區(qū)域。當光點探測單元在探測區(qū)域7內探測到導引光束照射地面的光點時,將進入跟蹤尋的狀態(tài),通過四項限位移傳感器或ccd成像探測器件,判定光點移動方向,并通過pid算法調整小車運動軌跡,實現(xiàn)對光點的實時跟蹤。
圖2給出導引裝置及被導引裝置的結構示意框圖。被導引裝置(小車或機器人)包含有光點探測及信號處理單元,微處理器(mcu)單元,轉向控制及小車驅動控制單元,通訊傳輸單元。導引裝置包含有導引光源及指示光源控制單元,微處理器(mcu)單元,多軸運動平臺控制單元,通訊傳輸單元。
其中光點探測單元實現(xiàn)對探測區(qū)域內光點的實時跟蹤探測,導引光束可采用持續(xù)發(fā)光或脈沖發(fā)光方式,若被導引裝置較少,在探測區(qū)域內只有一個導引光點時,可采用持續(xù)發(fā)光方式進行導引,若被導引裝置較多,有可能在相同探測區(qū)域出現(xiàn)多個光點時,需要采用不同頻率的光點進行區(qū)分,導引光源在選擇特定頻率進行導引時,會通過通訊傳輸單元告知被導引裝置,使用的導引光脈沖頻率是多少?被導引裝置將使用對應頻率實現(xiàn)同步檢測,這樣將可避免其他頻率導引光脈沖的干擾。微處理器單元依據(jù)當前時刻探測到的光點位置與上一時刻探測到的光點位置偏差,采用pid算法進行計算,產生驅動小車轉向及運動電機的驅動信號,實現(xiàn)實時跟蹤的目的。
為避免導引光源數(shù)量增多引起的光束雜亂狀況,導引光源可采用近紅外波長是905nm的近紅外光源,人眼將看不到導引光源的存在,為增加人眼辨識導引光源是否處于工作狀態(tài),可增加不同顏色可見指示光源進行標識,譬如讓導引光源的指示光源與被導引裝置的指示光源顯示相同顏色。多軸運動平臺控制單元會通過導引光束將被導引裝置導引至其正下方所處位置,當完成自己所處節(jié)點的導引工作后,會通過通訊控制單元告知遠程控制終端,遠程控制終端會自動分配下一個導引光源進行接力導引,確保被導引裝置運動至目的地。
圖3所示是在庫房或車間agv小車導引的示意圖,其中101表示要前往指定工作臺的去程agv小車,102表示返程的agv小車,圖中可看到為避免去程與返程小車的相碰,在行進的主干道上采取雙車道辦法,采用光學導引方式的優(yōu)點是小車行進的路線是可以隨時進行調整,而不必如磁條軌道那樣固定路徑。
圖4是本發(fā)明應用在單主干道導引路線示意圖,圖中實線箭頭表示去程線路,等間隔虛線箭頭表示返程線路。圖中圓圈所示的301,302…309共九個節(jié)點表示9個導引光源,主干道l1上有a,d,e三個導引光源節(jié)點,單主干道方式主要用在被導引裝置數(shù)量不多的應用場合。不妨以被導引裝置需要從節(jié)點e運行到節(jié)點b為例,首先是導引節(jié)點a的導引光源工作,導引小車先運行到節(jié)點a,當小車被導引至節(jié)點a正下方后,節(jié)點a告知遠程控制系統(tǒng)已完成去程導引,系統(tǒng)會自動安排節(jié)點b開始進行接力導引,返程時,先由節(jié)點a導引小車沿虛線箭頭路線由b抵達a位置,然后節(jié)點a告知遠程控制系統(tǒng)已完成返程導引,系統(tǒng)會自動安排節(jié)點e開始進行返程接力導引。這種單主干道導引方式主要應用在被導引裝置數(shù)量較少的狀況,圖4所示的節(jié)點a在不同時刻分別可完成ea,da,ba,ca四條線路的導引,針對被導引裝置較多的狀況,可通過在主干道增加導引光源節(jié)點方式來實現(xiàn)。
圖5是本發(fā)明應用在多主干道導引路線示意圖,相比圖4單主干道導引方式,圖5所示的多主干道方式在主干道時增加了311,312,321,322,331,332六個導引光源節(jié)點,與單主干道方式下的節(jié)點a的導引方式差異在于,單主干道方式下,導引節(jié)點a在同一時刻只能導引ea,da,ba,ca四條線路中的一條路徑,而多主干道方式下,導引節(jié)點a處有3個導引光源(305,321,322),因而在同一時刻可導引ea,da,ba,ca四條線路中的任意三條路徑,這樣在被導引裝置較多的狀況下會顯著提升系統(tǒng)導引效率。
以上所述僅為本發(fā)明的較佳實施例,并不用以限制本發(fā)明,凡在本發(fā)明的精神和原則之內,所做的任何修改、等同替換、改進,均應包含在本發(fā)明的保護范圍之內。