EPSON培训手册
程式範例:
3. 變數
MAIN.PRG Function Main Call Func1 ... Fend Function Func1 Jump pickpnt ...
Integer m_i ‘模組變數m_i Global (Preserve) Integer g_i ‘全局變數(全局保護變數)g_i Function main Integer I ‘局部變數i ... Fend ‘局部變數i
2.1 Go 指令
功能:全軸同時的PTP動作,動作的軌跡是各關節分别對從當前的點到目標座標進行差補。 格式:Go 目標座標 範例: 1. Go P1 ´機械手臂動作到P1點 2. Go XY(50, 400, 0, 0) ´機械手臂動作到X=50,Y=400,Z=0,U=0 3. Go P1+X(50) ´機械手臂動作到P1點X坐標值偏移量為+50的位置 4. Go P1:X(50) ´機械手臂動作到P1點對應X座標值為50的位置
4.變數的類型 變數有很多種類型,使用前先說明類型,格式為:數據類型變量名。例如: Integer i,定義變量i為整型數據。另外,代入的數據和變量的類型必須一致。在下 表中列出SPEL+ 語言中使用的數據類型。
13
六、動作指令
1. 動作指令分類 使機械手臂動作的指令叫作動作指令。 可分為:PTP動作指令,CP動作指令,Curves動作指令,Joint動作指令。
Bmove: 在指定的局部座標系(Local)上執行偏移直線差補動作。没有指定局部座標系時,以局部0(基準座標 系)為基準,進行偏移PTP 動作。 Tmove; 在當前的工具座標系上執行偏移直線插補動作。 CVMove: 用Curve 命令執行定義的自由曲線CP 動作。CVMove 執行設定控制器硬盤上的文件名的文件數據的 自由曲線CP 動作。此文件必須事先用Curve 命令制作。 > Curve “mycurve”, O, 0, 4, P1, P2, On 2, P(3:7) ´設定自由曲線 > Jump P1 ´用直線將手臂移動至P1 > CVMove “mycurve” ´用定義的自由曲線“mycurve”移動手臂
NOTE:
即使目標座標在機械手臂的動作範圍内,一旦在Move或Arc運動軌跡超過允許動作範圍外,機械手臂會突然停止, 给伺服馬達帶來撞擊,有產生故障的危險。為了防止這样的事發生,請在高速執行前先以低速進行動作範圍確認。
16
六、動作指令
3.3 Jump3/Jump3CP指令
功能:將手臂用3 维门形動作移動。Jump3是兩個CP動作與1個PTP動作的组合 格式:Jump3 退避座標,接近開始座標,目標座標 範例:Jump3 P1,P2,P3´從當前位置經過保存座標P1,接近座標P2運動到目標座標P3。如圖2所示
3.1 Move 指令
功能:以直線軌跡將機械手臂從當前位置移動到指定目標位置。全關節同時啟動,同時停止。 格式:Move 目標坐標 範例:Move P1 ´機械手臂以直線軌跡動作到P1點
NOTE:
Move與Go的區别:到達目標點時,對於手臂的姿勢擺放位置比較在意時使用Go命令,然而對於動作中的手臂軌 跡比較著重時使用Move 命令。在SCARA機械手臂只有Z軸上下動作時,Go與Move的軌跡一样。
表1
7
二、硬體概要
系统組成圖示
8
三、EPSON RC+ 用戶界面
9
四、示教
1. 微調Jog &Teach介面
打開Jog&Teach介面: Tools →Robot Manager →Jog&Teach或點選工具檔 圖標後,選擇Jog&Teach介面。如下圖示
Mode說明:
World:在當前的局部坐標系、工具坐標系、機械手臂属性、ECP坐標系上,向X、Y、Z轴的方向微調動 作。如果是SCARA型機械手臂,也可以向U方向微動。如果是垂直6軸型機械手臂,則可以向U方向(傾 斜)、V方向(仰卧)、W方向(偏轉)微動。 Local: 向定義的局部坐標系的方向微動移動。 Tool : 向工具定義的坐標系的方向微動移動。 Joint : 各機械手臂的關節單獨微調移動。不是直角坐標型的機械手臂使用Joint模式時,顯示單獨的 微調按钮。 ECP : 在用當前的外部控制點定義的坐標系上,微調動作。
14
六、動作指令
2. PTP指令
包括指令:Go、Jump、BGo、TGo PTP(Pose To Pose)動作,是與其動作軌跡無關,以機械手臂的工具頂端為目標位置使其動作的動作方法。 PTP動作,使用各關節上配置的電動機,使機械手臂通過最短的路徑到達目標位置。 優點:運動速度快,缺點:運動軌跡無法預測。指定PTP動作速度和加/减速,使用SPEED指令和ACCEL指令。
1、機械手臂座標系統 1.1 SCARA機械手臂座標系統
XY方向座標(前後左右)
Z方向座標(上下)
U方向座標(旋轉)
3
一、關于機械手臂的基本知識
1.2 垂直6軸型機械手臂的坐標系統
4
一、關于機械手臂的基本知識臂作動作時,有必要紀錄使用示教點位時的手臂姿势。如果不這樣做,根 據手臂姿势的不同,會產生輕微的位置偏移,或朝著意想不到的路徑做動作,會有干涉周邊 設備的危險。為了避免這種情况,在點位資料中必須事先指定其在該點位上動作時的手臂姿 勢(如下圖)。此訊息也可以從程式中變更(\L或者\R)。
15
六、動作指令
3. CP指令
包括指令:Move、Arc、Arc3、Jump3/Jump3CP、BMove、TMove、CVMove CP(Continuous Path )指令可以指定機械手臂到達目標位置的運動軌跡。 優点:軌跡可以控制,均速動作。缺点:速度慢。 指定Linear動作速度和加/减速度,使用SPEEDS指令和ACCELS指令。
EPSON 機械手臂導入培訓
台灣愛普生 FA 營業本部 2011年2月12日
1
内容
一、關於機械手臂的基本知識 二、硬體概要 三、EPSON RC+ 用户界面 四、示教 五、SPEL+語言 六、動作指令 七、I/O 八、Pallet 指令 九、!...! 並列處理 十、多任務處理
2
一、關于機械手臂的基本知識
10
四、示教
2. 示教點步驟
(1)在Points介面Points Files下拉選單中選擇需要教點的點文件 (2)在Jog&Teach介面右下角位置選擇需要示教的點編號
(3)微調將機械手臂移動到需要示教點的位置。如果是SCARA機 械手臂,Motor On情况下,可以在Control Panel 介面Free All釋放所有軸brake後,手動将機械手臂移動到需要示教的位 置後,Lock ALL鎖定所有軸。 (4)點擊Teach按紐,系统自動紀錄示教點在當前坐標系的具體 數值。如果需要示教的點位為新增點,將彈出以下對話框,用 户可根據需要對該點編輯標籤及說明 (5)在Robot Manager |Points介面點擊Save按钮,完成示教点。
圖2
NOTE:
1、Jump不能用於6軸機械手臂,6軸機械手臂只能使用Jump3和Jump3 CP指令 2、Jump3CP指令用法與Jump3類似,不同在於Jump3CP是3個CP動作的组合 3、SCARA機械手臂Z軸上升或下降動作時,使用Jump指令可以提高運动速度
3.4 BMove 、TMove、CVMove 指令
2.2.2 也可以在程式中指定機械手臂的姿勢,記述為“/” 與後面的L(左手姿勢)或R(右手姿勢)、A(上肘姿勢) 或B(下肘姿勢)、F(手腕翻轉姿勢)或NF(手腕非翻轉 姿勢)。手臂姿勢有以下8中组合,如表1所示,但因點而 異,並非所有的组合都可以動作。 垂直6軸型的機械手臂在第4關節、第6關節同軸的點上,即 使將第4關節、第6關節旋轉360度,也可以實現相同的位置 姿勢。作為用于區别像這樣點的點属性,有J4Flag和 J6Flag。指定J4Flag時,請記述斜槓(/)和其後的J4F0 (-180<J4關節角度<=180)、或J4F1(J4關節角度<= -180 或180 < J4關節角度)。指定J6Flag時,請記述斜槓(/) 和其后的J6F0 (-180<J6關節角度<=180)、或J6F1 (360 < J6關節角度<= -180 或180 < J6關節角度<= 360 )、 或J6Fn(-180*(n+1) < J6關節角度<= 180*n 或180*n < J6關節角度<= 180*(n+1))。
Function Func1 SPEL+中有3種不同範圍的變數。 Integer I • Local : 局部變數(用在同一Function内使用的變數) ... • Module : 模組變數(在同一程式内使用的變數) Fend • Global : 全局變數(在同一專案内使用的變數)
12
五、SPEL+語言
3.2 Arc和Arc3 指令
功能:Arc 在XY平面上以圓弧插補動作。 Arc3 在3D空間裡以圓弧插補動作。 格式:Arc 經過座標,目標座標 說明:將機械手臂從當前位置移到目標座標,通過中繼座標用圓弧插補動作活動時使用。從所给的3點(當前座 標座標、中繼座標、目標座標)自動演算圓弧插補軌道,並沿著此軌道移動機械手臂直至目標座標為止。 範例:Arc P2,P3
2.2 Jump 指令
功能:通過“门形動作”使手臂從當前位置移動至目標座標。 格式:Jump目標座標 範例: 图1 1. Jump P1 ´機械手臂以“门形動作”動作到P1点 2. Jump P1 LimZ -10 ´以限定第三軸目標座標Z=-10的门形動作移動到P1點,如圖1所示 3. Jump P1:Z(-10)LimZ -10 ´以限定第三軸木標座標Z=-10的门形動作移動到P1點位置Z座標值為-10的位置 NOTE: Jump與Go的區别:Jump與Go都是使機械手臂用PTP動作移动的命令。但是Jump有Go没有的一個功能。Jump将 機械手臂的手部先抬起至LimZ 值,然後使手臂水平移動,快要到目標座標上空的時候使其下降移动。此動作的 標準是可以更准確地避開障礙物物一點,更重要的是通過吸附、配置動作,提高作業的周期時間。