啤酒生產(chǎn)線介紹：
機(jī)械手抓瓶視頻：
啤酒生產(chǎn)線六自由度機(jī)械手抓瓶控制系統(tǒng)設(shè)計(jì)：
任務(wù)要求裝箱工藝主要分為2個(gè)部分：視覺檢測系統(tǒng)和機(jī)械手分部。 視覺檢測系統(tǒng)工作目的是：通過裝置于合適位置的攝像頭，對擺放在裝箱工作臺上的空箱體進(jìn)行拍攝，并對所拍攝到的圖像進(jìn)行處理，獲取裝瓶位的實(shí)時(shí)坐標(biāo)，并將坐標(biāo)傳送至控制機(jī)械手的PLC。 機(jī)械手部分的主要工作是：根據(jù)視覺檢測系統(tǒng)所獲得的裝瓶位坐標(biāo)，按照一定的軌跡，將通過貼標(biāo)分部的瓶體依次裝入箱體的裝瓶位。 項(xiàng)目技能點(diǎn) 1). 熟悉三菱Q系列PLC； 2). 熟悉三菱編程軟件GXDeveloper的使用方法； 3). 熟悉三菱六自由度機(jī)械手的使用 硬件介紹 本啤酒生產(chǎn)線裝箱分部所采用的是Q系列PLC的CPU為Q03UDCPU和Q172DRCPU。其中，Q03UDCPU為主CPU，Q172DRCPU為從CPU，即機(jī)器人CPU。 本次設(shè)計(jì)機(jī)器人分部中使用控制器為CR1Q-700系列，此控制器是與設(shè)計(jì)中使用的機(jī)械手專門匹配的控制器，為小型控制器，CPU設(shè)置類型為外部設(shè)置，在PLC基板上插入機(jī)器人控制器，省配線，不需要I/O模塊，使系統(tǒng)成本降低。 機(jī)械臂為RV-3SQ系列六自由度機(jī)械臂，為執(zhí)行動作的單元，具體型號為RV-3SQ-S11。 機(jī)械臂共六個(gè)關(guān)節(jié)，每個(gè)關(guān)節(jié)內(nèi)有一個(gè)伺服電動機(jī)，由絕對編碼器來檢測位置�？刂破髋c機(jī)械手間也是獨(dú)立的，通過兩條線纜即馬達(dá)動力線和編碼器信號線來連接它們，其中馬達(dá)線用來提供動力來驅(qū)動電機(jī)，信號線提供信號來控制電機(jī)。 硬件連接圖 軟件介紹 本分部用到軟件： 1、 RT ToolBox2 用于編寫機(jī)器人程序 2、 MELFA-Vision 視覺軟件，從攝像頭拍攝的相片中識別圓孔位置 3、 GX Developer 用于與前后分部的通信，程序已寫好（不到10行），不需要管 RT ToolBox2使用方法： 軟件的運(yùn)行狀態(tài)分為三種：離線、在線、模擬。 1、模擬狀態(tài) 選擇工作區(qū)-新建，通信設(shè)置如下： IP Address=192.168.0.5 Port=10001 Send Timeout=5000msec Recieve Timeout=30000msec 之后在菜單欄在線中選擇模擬，在左側(cè)工作區(qū)展開在線-程序，右鍵選擇新建，編寫程序，例如：（以下為本例中所用程序） 編輯完成按CTRL+S保存，將鼠標(biāo)置于工作區(qū)編寫的程序文件名處，右鍵選擇調(diào)試狀態(tài)下打開，開始模擬。 2、在線狀態(tài) 在線模式時(shí)，菜單欄在線中選擇在線，展開左側(cè)工作區(qū)在線-程序，編寫程序完畢后，在程序編輯區(qū)右鍵選擇全寫入，程序即可下載到控制器中。若在程序文件名處，右鍵選擇調(diào)試狀態(tài)下打開，則可進(jìn)行實(shí)時(shí)調(diào)試。 程序的運(yùn)行： 手控器背面白色按鈕應(yīng)彈開，并將鑰匙旋轉(zhuǎn)至自動模式，按下SVO ON打開伺服電源，按下START運(yùn)行程序。 另外還有示教模式可以手動控制機(jī)械臂，位置坐標(biāo)可以實(shí)時(shí)讀入。使用時(shí)先將鑰匙旋轉(zhuǎn)至手動模式，再將手控器背面白色按鈕應(yīng)按下，拉住手控器背面黃色按鈕（注意不要拉到頭），按下SERVO鍵，4秒后伺服指示燈亮，再按下JOG進(jìn)入示教模式�？梢赃x擇XYZ模式或JOINT模式。其中ＸＹＺ模式下，X、Y、Z控制機(jī)械臂末端位移，A、B、C控制姿態(tài)。JOINT模式下，控制各個(gè)關(guān)節(jié)單獨(dú)運(yùn)動。按下HAND鍵控制手爪，-C抓合，+C松開。 MELFA-Vision使用方法： 建立作業(yè)，點(diǎn)擊下圖綠色按鈕聯(lián)機(jī) 然后在RT TOOLBOX中運(yùn)行示例程序，程序中調(diào)用運(yùn)行作業(yè)（本例中使用的作業(yè)為“2013.job”）并使用函數(shù)讀取識別的圓孔坐標(biāo) 所做工作： 1、 程序流程圖設(shè)計(jì) 注意，這里只是開環(huán)控制，沒有引入反饋，系統(tǒng)不知道瓶子是否放到位。作為改進(jìn)，我 們設(shè)計(jì)了一種閉環(huán)控制系統(tǒng)，系統(tǒng)實(shí)時(shí)監(jiān)測機(jī)械臂抓手位置并與放瓶位進(jìn)行比較，通過偏差消除偏差。閉環(huán)系統(tǒng)框圖如下：（紫色區(qū)域?yàn)樵黾拥拈]環(huán)部分） 2、 程序代碼 Ovrd 30 '速度30% Mov P0 '開始移動到安全位置 HOpen 1 '打開手抓 If M_NvOpen(1)<>1 Then '如果端口沒有打開 NVOpen "COM2:" As #1 '打開2號端口作為1號 EndIf Wait M_NvOpen(1)=1 '等待打開 NVLoad #1,"2013" '讀入視覺里的程序“2013” NVPst #1,"2013","E76","J81","M100",0 '調(diào)用程序“2013”存入單元E76到J81中的數(shù)據(jù) For M1=1 To M_NvNum(1) '數(shù)據(jù)編號從1開始循環(huán) Mov P1 '抓瓶位置前方 Mvs P2 '抓瓶位置 Dly 0.1 '延時(shí) HClose 1 '閉合手抓 Dly 0.2 Mov P6 '抓瓶位置上方 Mov P4 '姿態(tài)調(diào)整 Mov P5 '放瓶位置上方 P10.X = P_NvS1(M1).X '調(diào)取視覺輸出X坐標(biāo) P10.Y = P_NvS1(M1).Y '調(diào)取視覺輸出Y坐標(biāo) P10.Z = 450 P11=P10 P11.Z=370 Mov P10 '移動至放瓶位置 Mvs P11 '垂直下放瓶 Dly 0.1 HOpen 1 Dly 0.2 P11.X=P10.X-20 '以下程序前后左右晃動是為了使瓶子更容易落入孔中 Mvs P11 P11.X=P10.X+20 Mvs P11 P11.Y=P10.Y-20 Mvs P11 P11.Y=P10.Y+20 Mvs P11 P11.X=P10.X-20 Mvs P11 P11.X=P10.X+20 Mvs P11 P11.Y=P10.Y-20 Mvs P11 P11.Y=P10.Y+20 Mvs P11 P10.Y=P10.Y+50 Mvs P10 Next M1 '下一個(gè)放瓶編號 Mov P0 Hlt ' 暫停 End 各點(diǎn)坐標(biāo)： P0=(463.910,-75.340,680.230,-120.360,75.850,-46.420)(6,0) P1=(459.520,-147.240,328.670,-121.440,76.300,-46.810)(6,0) P2=(453.870,-70.340,329.430,-120.450,75.850,-46.490)(6,0) P3=(57.620,-500.830,562.160,-125.830,85.470,152.050,0.000,0.000)(6,0) P4=(403.440,-178.560,679.430,-97.990,84.750,-117.210)(6,0) P5=(8.460,-433.000,696.350,-106.650,84.670,170.590)(6,0) P6=(463.910,-75.340,680.230,-120.360,75.850,-46.420)(6,0) P7=(8.460,-433.000,696.350,-106.650,84.670,170.590)(6,0) P10=(270.060,-647.260,450.740,-125.830,85.470,152.050,0.000,0.000)(6,0) P11=(270.060,-647.260,362.160,-125.830,85.470,152.050,0.000,0.000)(6,0) 3、 最終效果 本程序最終效果，12個(gè)瓶中有兩個(gè)未能成功落入孔中，抓瓶和下落過程還有偏差，有待完善！ 4、 感想： 這次實(shí)習(xí)通過對三菱六自由度機(jī)械手的學(xué)習(xí)，讓我學(xué)到了很多東西。剛開始的時(shí)候感覺困難重重，不知道該從何下手。通過對使用文檔的閱讀和向老師請教，慢慢熟悉了機(jī)械手的示教方法和編程方法，后來又學(xué)會了視覺系統(tǒng)的使用以及校正。最后通過努力，將視覺系統(tǒng)與機(jī)械手結(jié)合在一起，達(dá)到了預(yù)期的效果。在這短短幾天的實(shí)習(xí)中，每天都有新的問題，同時(shí)也有新的進(jìn)展。這讓我明白了無論學(xué)習(xí)還是做事，只要迎難而上并持之以恒，沒有解決不了的問題。
| 
