欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標(biāo)題: 啤酒生產(chǎn)線六自由度機(jī)械手抓瓶控制系統(tǒng)設(shè)計(jì) [打印本頁]

作者: xiaoyao 時(shí)間: 2014-12-17 14:50
標(biāo)題: 啤酒生產(chǎn)線六自由度機(jī)械手抓瓶控制系統(tǒng)設(shè)計(jì)

啤酒生產(chǎn)線介紹：

機(jī)械手抓瓶視頻：

啤酒生產(chǎn)線六自由度機(jī)械手抓瓶控制系統(tǒng)設(shè)計(jì)：
任務(wù)要求

裝箱工藝主要分為2個(gè)部分：視覺檢測系統(tǒng)和機(jī)械手分部。

視覺檢測系統(tǒng)工作目的是：通過裝置于合適位置的攝像頭，對(duì)擺放在裝箱工作臺(tái)上的空箱體進(jìn)行拍攝，并對(duì)所拍攝到的圖像進(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í)行動(dòng)作的單元，具體型號(hào)為RV-3SQ-S11。

機(jī)械臂共六個(gè)關(guān)節(jié)，每個(gè)關(guān)節(jié)內(nèi)有一個(gè)伺服電動(dòng)機(jī)，由絕對(duì)編碼器來檢測位置。控制器與機(jī)械手間也是獨(dú)立的，通過兩條線纜即馬達(dá)動(dòng)力線和編碼器信號(hào)線來連接它們，其中馬達(dá)線用來提供動(dòng)力來驅(qū)動(dòng)電機(jī)，信號(hào)線提供信號(hào)來控制電機(jī)。

硬件連接圖

軟件介紹

本分部用到軟件：

1、 RT ToolBox2

用于編寫機(jī)器人程序

2、 MELFA-Vision

視覺軟件，從攝像頭拍攝的相片中識(shí)別圓孔位置

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)至自動(dòng)模式，按下SVO ON打開伺服電源，按下START運(yùn)行程序。

另外還有示教模式可以手動(dòng)控制機(jī)械臂，位置坐標(biāo)可以實(shí)時(shí)讀入。使用時(shí)先將鑰匙旋轉(zhuǎn)至手動(dòng)模式，再將手控器背面白色按鈕應(yīng)按下，拉住手控器背面黃色按鈕（注意不要拉到頭），按下SERVO鍵，4秒后伺服指示燈亮，再按下JOG進(jìn)入示教模式。可以選擇XYZ模式或JOINT模式。其中ＸＹＺ模式下，X、Y、Z控制機(jī)械臂末端位移，A、B、C控制姿態(tài)。JOINT模式下，控制各個(gè)關(guān)節(jié)單獨(dú)運(yùn)動(dòng)。按下HAND鍵控制手爪，-C抓合，+C松開。

MELFA-Vision使用方法：

建立作業(yè)，點(diǎn)擊下圖綠色按鈕聯(lián)機(jī)

然后在RT TOOLBOX中運(yùn)行示例程序，程序中調(diào)用運(yùn)行作業(yè)（本例中使用的作業(yè)為“2013.job”）并使用函數(shù)讀取識(shí)別的圓孔坐標(biāo)

所做工作：

1、程序流程圖設(shè)計(jì)

注意，這里只是開環(huán)控制，沒有引入反饋，系統(tǒng)不知道瓶子是否放到位。作為改進(jìn)，我

們?cè)O(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 '開始移動(dòng)到安全位置

HOpen 1 '打開手抓

If M_NvOpen(1)<>1 Then '如果端口沒有打開

NVOpen "COM2:" As #1 '打開2號(hào)端口作為1號(hào)

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ù)編號(hào)從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 '移動(dòng)至放瓶位置

Mvs P11 '垂直下放瓶

Dly 0.1

HOpen 1

Dly 0.2

P11.X=P10.X-20 '以下程序前后左右晃動(dòng)是為了使瓶子更容易落入孔中

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è)放瓶編號(hào)

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í)通過對(duì)三菱六自由度機(jī)械手的學(xué)習(xí)，讓我學(xué)到了很多東西。剛開始的時(shí)候感覺困難重重，不知道該從何下手。通過對(duì)使用文檔的閱讀和向老師請(qǐng)教，慢慢熟悉了機(jī)械手的示教方法和編程方法，后來又學(xué)會(huì)了視覺系統(tǒng)的使用以及校正。最后通過努力，將視覺系統(tǒng)與機(jī)械手結(jié)合在一起，達(dá)到了預(yù)期的效果。在這短短幾天的實(shí)習(xí)中，每天都有新的問題，同時(shí)也有新的進(jìn)展。這讓我明白了無論學(xué)習(xí)還是做事，只要迎難而上并持之以恒，沒有解決不了的問題。

歡迎光臨 (http://www.raoushi.com/bbs/)