朱錦順 吳 翔
上海振華重工(集團)股份有限公司 上海 200125
隨著自動化碼頭的不斷發(fā)展,碼頭設備正朝著高速化、自動化和智能化方向發(fā)展,AGV(Automated Guided Vehicle)逐漸替代傳統(tǒng)集卡成為自動化碼頭的重要搬運設備,對岸邊集裝箱起重機(以下簡稱岸橋)和AGV協(xié)同作業(yè)的可靠性、高效性等多方面提出了更高要求。
目前,國內(nèi)多個自動化碼頭都已采用主小車對中轉(zhuǎn)平臺、門架小車對AGV作業(yè)的分布作業(yè)模式,若對作業(yè)箱型識別錯誤或AGV位置檢測偏差大則會降低門架小車作業(yè)效率,故對AGV作業(yè)的快慢將直接影響整個碼頭的作業(yè)效率,如何提高對空AGV或AGV帶箱的位置檢測準確度至關(guān)重要。
目前,最常見的AGV定位方案為地面安裝磁釘[1],但在大小車方向定位偏差較大,且無法識別AGV上是否有集裝箱及所載集裝箱尺寸,故該方案對實現(xiàn)門架對AGV側(cè)作業(yè)自動化難度較大;另一種方案是利用安裝于門架小車平臺的激光器進行掃描定位[2],但最大弊端是需門架小車運行至AGV上方才能開啟掃描,且到位后需在掃描高度處等待直至掃描完成,故增加了AGV側(cè)的作業(yè)時間。本次設計的基于安裝于固定位置的激光掃描檢測系統(tǒng)為AGV定位系統(tǒng),簡稱APS(AGV Position System),只需AGV到達工作車道即可提前開啟掃描,無需等待門架吊具運行至AGV上方,大大節(jié)省了掃描時間,可有效檢測AGV在小車方向和大車方向的位置及旋轉(zhuǎn)角度,并在此基礎(chǔ)上校驗控制系統(tǒng)發(fā)送的任務信息、校驗AGV上集裝箱信息、對空AGV或帶箱AGV進行精確定位,將最終檢測結(jié)果發(fā)送至控制系統(tǒng),實現(xiàn)門架小車對AGV自動化裝、卸作業(yè)。除此之外,還能實時監(jiān)控AGV是否移動,防止吊具下降過程中因AGV移動距離過大導致吊具砸到AGV造成安全隱患,確保了作業(yè)的安全性。
為適應多個AGV車道工作,系統(tǒng)使用激光器加轉(zhuǎn)動馬達的組合方式,簡稱3D掃描儀,其掃描范圍可覆蓋多個AGV車道。當裝船作業(yè)時,APS系統(tǒng)檢測AGV上的集裝箱進行識別計算;當卸船作業(yè)時,APS系統(tǒng)檢測AGV框架結(jié)構(gòu)進行位置計算。根據(jù)作業(yè)車道信息,APS系統(tǒng)控制3D掃描儀轉(zhuǎn)動到不同的作業(yè)車道進行AGV監(jiān)控和位置檢測定位,從而實現(xiàn)門架小車對AGV的自動化作業(yè),系統(tǒng)掃描原理圖如圖1所示。
圖1 系統(tǒng)掃描原理圖
APS系統(tǒng)可實現(xiàn)的功能有:1)檢測空AGV或帶箱AGV在大車方向的偏差值;2)檢測空AGV或帶箱AGV在小車方向的偏差值; 3)檢測空AGV或帶箱AGV在水平面投影的旋轉(zhuǎn)角度; 4)校驗控制系統(tǒng)發(fā)送的任務信息與APS檢測信息是否一致,不一致則報錯禁止自動化作業(yè);5)校驗AGV上集裝箱信息,比如箱形尺寸、雙箱間隙,集裝箱在AGV上位置(左20 ft、中20 ft或右20 ft); 6)實時監(jiān)控AGV在大車方向是否移動。
該系統(tǒng)由高精度激光器及高精度的伺服電機組合構(gòu)成3D掃描儀,為更好地適用于多個AGV車道及提高掃描精度,采用2套3D掃描儀安裝于不同車道上方,系統(tǒng)優(yōu)先選擇靠近工作車道的3D掃描儀的檢測結(jié)果,其中3D掃描儀安裝位置與AGV車道位置關(guān)系如圖2所示。
圖2 安裝位置右視圖
本次設計體現(xiàn)冗余原則,每套APS獨立與主控系統(tǒng)通訊,當一套APS出現(xiàn)硬件故障或算法錯誤時可自動切換至另一套進行工作,系統(tǒng)結(jié)構(gòu)如圖3所示。
圖3 系統(tǒng)結(jié)構(gòu)圖
為確保通訊的穩(wěn)定性,采用DP從站的模式與主控系統(tǒng)PLC進行通訊,而激光器和轉(zhuǎn)動馬達一同接入交換機與APS控制器以以太網(wǎng)方式進行通訊,本設計硬件結(jié)構(gòu)簡單,2套APS關(guān)聯(lián)性弱,系統(tǒng)穩(wěn)定性強。
軟件將邏輯處理層和硬件驅(qū)動及算法處理分成Server和 Client兩部分。其中,Server端的作用是負責與主控系統(tǒng)通訊,獲取AGV作業(yè)車道、作業(yè)集裝箱尺寸及位置等信息;與Client通訊,獲取Client端計算結(jié)果并與主控系統(tǒng)發(fā)送的任務信息進行校驗;將Client端分析處理后得到的AGV位置信息等數(shù)據(jù)發(fā)送至主控系統(tǒng)進行吊具姿態(tài)控制進行自動化作業(yè)。Client端的作用是與Server端通訊,馬達提前擺動至作業(yè)車道進行掃描;負責與硬件通訊,包括轉(zhuǎn)動馬達和激光器,獲取實時硬件狀態(tài);獲取激光掃描數(shù)據(jù)及點云數(shù)據(jù)分析處理。
該軟件模式可支持1個Server對1個Client或1個server對多個Client的應用場景,如左右聯(lián)系梁各安裝一套3D掃描儀則可使用1個Server對2個Client的模式,可兼容不同項目的需求。本次使用的軟件如圖4所示,Server端可顯示Client端硬件實時狀態(tài)及主控系統(tǒng)發(fā)送的指令,Client端可顯示最近幾次指令檢測出的AGV帶箱信息及位置偏差等數(shù)據(jù)。
圖4 系統(tǒng)軟件
為提高對激光數(shù)據(jù)識別準確度及識別效率,以測試使用的AGV框架進行三維數(shù)據(jù)建模,并引入激光點云處理算法,AGV框架實際照片和空AGV及AGV帶箱掃描數(shù)據(jù)點云處理后結(jié)果分別如圖5、圖6所示。
圖5 AGV模型照片
圖6 AGV點云數(shù)據(jù)識別
如圖7所示,AGV不帶箱時,在原始點云數(shù)據(jù)的基礎(chǔ)上提取AGV托板上表面數(shù)據(jù),根據(jù)AGV托板的對稱性結(jié)構(gòu)及上層下發(fā)的具體作業(yè)指令,即可計算獲得目標位置信息,主要包括作業(yè)中心位置的大、小車方向坐標、作業(yè)安全高度、托板旋轉(zhuǎn)角度等信息。
圖7 集裝箱點云數(shù)據(jù)識別
AGV帶箱則會以集裝箱上頂面及側(cè)面點云數(shù)據(jù)作為基準,計算目標位置信息及集裝箱長度信息。由于帶箱時,集裝箱距離激光器更近、集裝箱形狀相較于AGV托板更加規(guī)則,故帶箱情況計算結(jié)果更準確。
為適應不同碼頭的多種AGV作業(yè)需求,系統(tǒng)支持多種AGV模型識別,不同類型AGV托板上表面特征點差別較大,如圖8、圖9所示兩種不同AGV照片和激光掃描數(shù)據(jù)對比。
圖8 不同類型AGV照片
圖9 不同類型AGV激光掃描數(shù)據(jù)
系統(tǒng)根據(jù)上層下發(fā)的作業(yè)AGV型號,進行相應特征的提取及運算,可有效計算得到AGV的位置信息,其中,有些國外碼頭有多達8種型號AGV,已測試過程序算法對這8種AGV皆有良好的適應性和準確的識別率。
為驗證APS系統(tǒng)的檢測精度,分別從檢測大車距離、小車距離、旋轉(zhuǎn)角度這3個參數(shù)入手,測試了AGV帶40 ft、45 ft、雙20 ft及空AGV等工況,同時人工測量及計算來校驗APS檢測結(jié)果是否準確。
以空AGV及AGV帶40 ft集裝箱測試為例,使用全站儀進行打點測量,以大車軌道進行建系,利用全站儀測量點A和點B坐標(A點和B點需為機械對稱點),則剩余數(shù)據(jù) C(小車方向距中心距離)、D(大車方向距中心距離) 、α(旋轉(zhuǎn)角度)都可以根據(jù)點A和點B坐標計算得出,測試示意圖如圖10所示。
圖10 測試示意圖
假設 A點坐標(X1,Y1,Z1),B點坐標(X2,Y2,Z2),其中X為小車方向,Y為大車方向,Z為起升方向,AGV寬度為W,AGV長度為L(測試AGV帶集裝箱時W為集裝箱寬度,L為集裝箱長度),則所需數(shù)據(jù)C、D、α計算公式為
由表1、表2測試數(shù)據(jù)可知,分別將測量得到的C值與APS檢測出的小車位置(大車陸側(cè)軌道為零位)、D值與APS檢測出的大車方向偏移距離及α值與APS檢測出的旋轉(zhuǎn)角度對比,經(jīng)實際測試數(shù)據(jù)驗證,大小車方向偏差都<40 mm,旋轉(zhuǎn)角度偏差<0.3°,這3項參數(shù)都滿足實際作業(yè)需求。
表1 空AGV測試結(jié)果
表2 AGV帶箱測試結(jié)果