基于三菱工業機器人的物料入庫系統研究

高功臣

摘 要： 根據被傳送物料的形狀及材質特征為其設計了合適的機械手，對物料進行抓握操作。工業機器人由物料臺抓握物料后，沿著預先設定的軌跡將物料傳送至立體倉庫前的待入庫工位，并且按照設定的操作流程自動檢查并選擇空庫位，將物料平穩的放入倉庫。結果表明，該系統提高了工作效率，減少了生產中的人力成本。

關鍵詞： 工業機器人； 物料； 入庫； 機械手

中圖分類號： TP 241 文獻標志碼： A 文章編號： 1671-2153（2015）02-0059-04

0 引 言

隨著科技的快速發展，機器人技術已經廣泛地應用在工業生產的各個方面。本文以三菱RV-3SD型六軸工業機器人為載體設計一個可以在狹小工作空間內進行物料搬運及自動入庫的傳輸系統。該系統能夠自動檢測物料臺上物料的有無，可以在狹小空間內進行物料的搬運，在入庫時還可以自動檢測庫位是否為空，并按照要求自動選擇空庫位進行入庫操作。

1 問題提出

三菱工業機器人在進行物料入庫操作時，首先機器人由待機位置出發，按照設定的運動路徑到達物料臺附近，由機械手從物料臺上抓取等待入庫的物料，然后再沿著規定的路徑到達立體倉庫的附近，按照設定的入庫算法，查找一個空的庫位并將物料入庫，最后機器人回到待機位置，等待下次入庫操作。在實際工作現場機器人、立體倉庫和物料臺的相對位置如圖1所示。

圖1中，由H形曲線所圍區域為機器人可以到達工作范圍，其中標注20°角所在區域為機器人的運動死區[1]，該區域受到機器人本體結構的限制而不能到達；而在H型曲線靠近障礙物的一側，因受到障礙物的阻擋，機器人亦不能到達該區域。另外，三菱工業機器人本體除了6個運動軸之外，并沒有其他可以選用的加工或握持工具。

為了解決上述問題，本文根據物料入庫空間要求以及機器人運動范圍要求，為機器人入庫運動設計了合適的運動軌跡，并且根據所需抓握物料的特性設計了實用的機械手。

2 機器人手抓設計

三菱RV?3SD型工業機器人本體只有J1～J6六個軸[1]，機器人在出廠時并沒有提供可以抓握物料的機械手，所以此處需要根據入庫物料的外形及材質特征設計一個合適的機械手。需要入庫物料的基本形狀為90×90×30的正方體，其材質為鋁合金。物料在入庫時，90×30的工作面與機械手相接觸；另外，機器人本體已經提供了氣動接口和所需的氣動元件位置檢測信號接口，所以此處設計一個由兩個手指構成的氣動機械手，其外形如圖2所示。

該機械手通過安裝底座安裝于機器人的J6軸端，由平行開閉式氣缸驅動兩個手指進行開閉運動，由安裝于氣缸上的兩個磁性開關檢測機械手的兩個手指是否運動到位，從而實現正方體物料的抓握。

該機械手的運動可以由機器人本體自帶的氣動接口進行驅動，僅需要在機器人底座進氣口導入壓力合適的氣源即可[1]。根據抓握物料所需力的大小，調節導入空氣的壓力。另外，平行開閉式氣缸的位置可以通過磁性開關來檢測。磁性開關的信號通過機器人本體自帶的信號接口，經通信電纜將信號傳遞到機器人控制器，由控制器控制機械手的運動。

3 物料和倉儲庫位檢測設計

本系統采用漫反射式光電開關來檢測物料臺上物料的有無，該傳感器安裝于物料臺的正下方，當物料到達物料臺時，漫反射式光電開關被觸發，將信號發送至機器人控制器，從而驅動機器人去抓握物料，并將其送入立體倉庫。

本系統采用光纖傳感器來檢測立體倉庫的庫位是否為空。在機械手的一個手指的一側設計一個光纖傳感器的安裝孔，將傳感器的探頭安裝固定于該孔內，該安裝方式可以防止傳感器在使用過程中受損。當物料需要入庫時，先讓安裝有傳感器的手指正對所需入庫的庫位，通過光路是否被阻擋來檢測該庫位是否為空。如果庫位為空則可以直接將物料入庫，否則，機器人需轉向下一個庫位重復上述操作，直至找到空庫位或者把所有庫位查找一遍為止。

4 機器人物料入庫程序設計

三菱RV?3SD型工業機器人采用MELFA?BASIC V語言設計驅動程序，但在設計機器人物料入庫程序之前，需要對機器人的運動軌跡進行合理的規劃，防止由于機器人的運動路徑或姿態不正確，導致機器人在運動過程中與障礙物相撞或受到機械限位的限制而無法正常運動。

4.1 機器人運動軌跡規劃

由圖1可知，機器人在物料入庫的工作區域中，不僅受到實際運動空間的限制，而且還受到機器人自身機械限位的限制，為了實現物料的順利入庫，必須提前對機器人的運動軌跡進行合理的規劃，這樣不僅能夠避免機器人與周圍物體發生碰撞，實現物料入庫的目的，而且也能夠提高機器人的工作效率。

機器人處在待機位置時，其各關節都處于收縮狀態，該狀態占用空間最小。本系統把該位置的空間坐標設置為P0，如圖3所示。圖3中，機器人在抓取物料的過程中，由P0點運動到P1點，并且上升，使得各關節伸張；再由P1點運動到P2點，并改變機器人的機械手姿態，為抓握物料做好準備；然后由P2點運動到P3點，下降并靠近物料。機器人在抓握工件時，由P3點運動到物料所在位置P4點，抓握物料后，上升運動，回到P3點。機器人在從物料臺搬運物料到立體倉庫時，由P3點運動到P2點，再由P2點運動到P1點，然后由P1點運動到P5點并靠近倉庫。當機器人將物料送入立體倉庫時，由P5點運動到立體倉庫的第一個庫位P6點，并在P6點附近找到空的庫位將物料入庫，然后回到P6點。當機器人返回待機位置時，由P6點運動到P5點，再由P5點運動到P1點，然后機器人回到待機位置P0。圖3中，符號“☉”和“⊕”分別代表機器人在豎直方向的上升運動和下降運動。

經過上述的一個工作流程，機器人將物料從物料臺運送到立體倉庫規定的庫位，然后機器人回到待機位置，等待再一次的入庫操作。

4.2 物料搬運及入庫程序設計

三菱RV?3SD型工業機器人可以使用的工作坐標系主要有關節坐標系和直角坐標系。其中關節坐標系主要應用在工作空間較為開闊的地方，此時機器人在兩點間選擇合理的路徑運動，并且可以改變機械手的運動姿態；而直角坐標系主要應用在工作空間較為狹小、周圍障礙物較多的地方，機器人按照控制器所提供的直角坐標進行直線運動，但不能改變機械手的運動姿態，所以在程序設計的過程中，應根據需要對機器人的工作坐標系進行調整，使其能夠完成所需的操作。

機器人在進行物料入庫工作時，首先檢測物料臺上是否有物料存在，如果沒有物料，則其在待機位置等待；一旦檢測到物料到達，機器人控制器將機器人本體的伺服電源打開，驅動機器人沿著規定的路徑運動到物料臺上方；機器人控制器發出控制信號，使得機械手張開，并驅動機器人向下運動到合適位置，將物料抓握；然后機器人沿著規定的路徑運動到立體倉庫前，并檢測所需庫位是否為空，如果已有物料存在，則機器人向下一個庫位移動，并重復上述檢測過程，直至找到一個空庫位，則直接入庫，并返回待機位置，等待下一次的入庫工作。當立體倉庫所有庫位均有物料時，機器人返回待機位置，并將伺服電源關閉，其工作流程如圖4所示。

根據機器人物料入庫程序設計流程便可以使用三菱機器人程序設計軟件RT ToolBox2[3]編寫及調試驅動程序，在程序調試的過程中，需要將程序中所涉及的機器人運動關鍵點位用示教單元進行現場示教并保存[2]，此處就不再贅述。

5 結束語

基于三菱RV?3SD型工業機器人物料入庫系統經過生產現場的實際測試，該系統運行良好。本系統可代替人工進行重復性的物料入庫工作，不僅提高了生產效率，而且減少了生產中的人力成本。另外，該系統的工作效率還可以通過優化機器人的運動軌跡、調整機器人的運動速度來進一步提高。

參考文獻：

[1] Mitsubishi Electric Corporation. Mitsubishi Industrial Robot RV-3SD/3SDJ Series Standard Specifications Manual[DB/OL]. （2008-07-26）[2013-07-04]. http：//cn.mitsubishielectric.com/fa/zh/download/dwn_idx_manual.asp.

[2] Mitsubishi Electric Corporation. Mitsubishi Industrial Robot CR1D＼ CR2D＼ CR3D controller INSTRUCTION MANUAL Detailed explanations of functions and operations [DB/OL]. （2008-09-01）[2013-07-04]. http：//cn.mitsubishielectric.com/fa/zh/download/dwn_idx_manu

al.asp.

[3] Mitsubishi Electric Corporation. RT ToolBox2/RT ToolBox2mini Users Manual [DB/OL]. （2008-08）[2013-07-04]. http：//cn.mitsubishielectric.com/fa/zh/download/dwn_idx_manual.asp.

Abstract： Based on Mitsubishi RV-3SD type six axis industrial robots as the carrier material storage system， this system can efficiently complete the automatic transmission and storage operation from the material station to the warehouse. According to the transmitted materials shape and material characteristics， this paper designs a suitable mechanical hand to grab material. After industrial robot grasps material form the material station， the material along the prespecified trajectory can be transferred to be storage station before stereoscopic warehouse， and according to set operation process automatic check and select empty library， the material is stable in storage.

Key words： industrial robot； material； storage； Manipulator

（責任編輯：徐興華）