FollowMove物件的屬性設定方針

Step 1. 設定基本資訊
設定基本資訊相關屬性(Name、Description、Enabled、StepID、AbortSeqOnFail)。

屬性
說明、設定指南
Name

設定力覺引導物件名稱。

設定特定名稱。

Description

設定力覺引導物件的描述。

描述動作說明等。設定任意字串。

Enabled 設定是否執行力覺引導物件。
True:正常
False:例如改為執行其他力覺引導物件等情形
StepID

力覺引導物件執行期間的StepID。

設定任意ID。

StepID為記錄於記錄資料中的ID。協助您了解日誌資料對應哪個工程。

力覺引導序列的AutoStepID為False時適用。

AbortSeqOnFail 設定是否在力覺引導物件失敗時結束或繼續執行力覺引導序列。

True:正常

結束力覺引導序列。

False:包含力覺引導序列中失敗時的復原動作時,或失敗後仍可繼續執行力覺引導序列時

Step 2. 開始前設定I/O處理
設定力覺引導物件開始前的I/O處理相關屬性(IOPreprocEnabled, IOPreprocOutputBit, IOPreprocOutputStatus)。

屬性
說明、設定指南
IOPreprocEnabled

設定是否在力覺引導物件開始時操作輸出位元。

您僅可操作一個輸出位元。若要操作數個輸出位元,請使用SPELFunc物件。

False:正常
True:操作輸出位元時,如操作/停止周邊設備
IOPreprocOutputBit 開始力覺引導物件時,請指定要操作的輸出位。
IOPreprocOutputStatus

開始力覺引導物件時,設定是否要開啟或關閉輸出位。

設定要輸出的狀態。

Step 3. 設定移動動作
設定移動相關屬性(MotionTrajectory, AccelS, AccelR, SpeedS, SpeedR, CPEnabled)。

屬性
說明、設定指南
MotionTrajectory 設定移動的軌跡類型。
Straight :想要直線動作時
Arc :想要曲線動作時
MultiStraight :想要多個點連續做直線動作時
MultiStraightCP :想要多個點在連接軌道連續做直線動作時

AccelS

AccelR

設定移動的加速。
AccelS:平移加速
AccelR:旋轉加速
實際加速是由力控制功能調整。

SpeedS

SpeedR

設定移動速度。
SpeedS:平移速度
SpeedR:旋轉速度
實際速度是由力控制功能調整。
SpeedRPriority

設置移動時是否優先SpeedR屬性。

如果點之間的姿態變化相對於移動距離較大,則使用SpeedS屬性動作時,可能會出現加速度錯誤。

AutoDistOrientRatio根據點之間的移動距離和姿態變化自動確定是否使用SpeedR屬性。推薦選擇AutoDistOrientRatio。

固定在SpeedS屬性或SPeedR屬性時,請選擇Disabled或Enabled。

Disabled:始終使用SpeedS屬性時
Enabled:始終使用SpeedR屬性時
CPEnabled 設定是否根據路徑動作連接FollowMove物件的軌跡及下列力覺引導物件的軌跡。
True:由多個循跡移動物件連接複雜軌跡同時執行動作時

Step 4. 設定目標地點
設定移動軌跡相關屬性(DestType, DestPoint, MidPoint, RelativeOrient, RelativeRobotLocal, DestRelativeX, …, DestRelativeW, MidRelativeX, …, MidRelativeW)。

屬性
說明、設定指南
DestType

此屬性可設定目的地點的設定方式。

若使用力控制功能,機器人位置會由力調整。因此,建議透過相對移動量,從定位點指定目的地點。

RobotPoint:移至指定點時

Relative:指定相對移動量時

DestPoint

設定代表目的地點的點位(DestPoint)。

MotionTrajectory中選擇Straight時:

如下圖所示,機器人會從力覺引導物件的開始位置以直線往目標位置移動。

画像

MidPoint

MotionTrajectory為Arc時,設定代表中點的點位(MidPoint)。

如下圖所示,機器人會在通過MidPoint後往DestPoint移動。

画像

RelativeOrient 設定將作為相對移動參考的座標系方向。

指定Base或Local時:

從外側檢視時,機器人始終會往定義方向運作。

以下為設定Base的範例。往-Z方向移動時,即使機器人的手指方向改變,機器人始終會垂直向下(基礎座標系中的-Z方向)移動。(黑色箭頭為機器人動作方向。)

若需機器人往與基礎座標系不同的方向移動,請在本地座標系中指定。

画像

指定Tool時:

移動方向會沿起始點的方向改變。

以下為設定Tool的範例。往+Z方向移動時,移動方向會視開始時的機器人手指方向變更。

画像

Base, Local:

在力覺引導物件起始點的機器人姿勢即使已變更,從外側看機器人總是朝著一定的方向移動。

Tool:

若要按照機器人姿勢的方向移動。

RelativeRobotLocal 設定由RelativeOrient指定Local時使用的本地座標系編號。

DestRelativeX

DestRelativeY

DestRelativeZ

DestRelativeU

DestRelativeV

DestRelativeW

指定各方向從力覺引導物件開始位置至目標位置的相對移動量。

如下圖所示,根據RelativeOrient設定座標系中各方向的相對移動量。

画像

MidRelativeX

MidRelativeY

MidRelativeZ

MidRelativeU

MidRelativeV

MidRelativeW

指定各方向從力覺引導物件開始位置至中點的相對移動量。

画像

如下圖所示,根據RelativeOrient設定座標系中各方向的相對移動量。

StartPoint

EndPoint

當MotionTrajectory是MultiStraight或MultiStraighCP時,設置力覺引導物件的連續操作開始位置和結束位置。

如下圖所示,在StartPoint設定P1、EndPoint設定P3時,按P1、P2、P3 的順序連續移動。

画像

Step 5: 設定力控制功能
設定力控制功能相關屬性(Fx_ControlMode, …, Tz_ControlMode, Fx_Firmness, …, Tz_Firmness, CFEnabled)。

屬性
說明、設定指南

Fx_ControlMode

Fy_ControlMode

Fz_ControlMode

Tx_ControlMode

Ty_ControlMode

Tz_ControlMode

設定各方向的力控制功能模式。

指定Follow時:

透過力控制功能執行跟隨動作。

指定Disabled時:

力控制功能隨即停用。

將欲跟隨方向的ControlMode設為Follow。

您必須將Follow設為一個以上的方向。

Fx_Firmness
Fy_Firmness
Fz_Firmness
Tx_Firmness
Ty_Firmness
Tz_Firmness
針對各方向設定力控制功能硬度。

設定較大值時:

力控制功能會增強,且反應速度較慢。

設定較小值時:

力控制功能會減弱,反應速度較快,但容易發生振動。

CFEnabled 設定是否要對下一個力覺引導物件繼續執行力控制功能。

False:正常

先關閉力控制功能,再執行下一個力覺引導物件。

True:接觸後,欲維持穩定力開始下一個力覺引導物件時

下一個力覺引導物件必須維持在各ControlMode中選擇Follow方向的力控制。

您可使用模擬器查看ControlMode設定。非已啟用的方向,將顯示為灰色座標系。但機器人會視目前位置顯示。查看設定時,請確認將機器人移至執行力覺引導物件的位置。如需如何使用模擬器進行檢查的詳細資訊,請參閱下列手冊。
"Epson RC+ 8.0用戶指南 - 模擬器 - 功能描述"

Step 6: 設定結束條件的基本資訊
設定結束條件組合的相關屬性(EndCheckOperator)。

屬性
說明、設定指南
EndCheckOperator

此屬性可設定結合位置及I/O相關結束條件的方式。

AND:符合兩個條件時結束

OR:符合一或多個條件時結束

Step 7. 設定位置相關的結束條件
設定與位置結束條件相關的屬性(PosCheckEnabled, PosCheckType, PlaneNumber, PlaneEndCond, PlaneRelativeOrg, PlaneRelativeX, PlaneRelativeY, PlaneRelativeZ, PlaneRelativeOrient, PlaneAxes, PlaneRelativeRobotLocal)。

屬性
說明、設定指南
PosCheckEnabled

此屬性可設定是否啟用位置的結束條件。

True:要啟用位置相關的結束條件時

False:要停用位置相關的結束條件時

PosCheckType 選擇與位置相關結束條件的類型。

選擇RobotPlane時:

結束條件以設定的Plane為基準。

如下圖所示,不論Robot的位置姿勢,都使用此屬性依據定義位置設定結束條件。

画像

選擇RelativePlane時:

每次執行力覺引導序列時,從目前位置的相對位置建立Plane,並設為位置結束條件。

如下圖所示,視開始時的位置姿勢,使用此屬性變更做為結束條件的位置。

画像

PlaneNumber 設定用於位置結束條件的Plane編號。

PosCheckType為RobotPlane時:

依據指定的Plane編號設定結束條件。

PosCheckType為RelativePlane時:

每次執行力覺引導序列時,都重新為指定編號設定Plane。

請設定空白的Plane編號。

PlaneEndCond

設定作為位置結束條件的狀態。

將內側(Inside)或外側(Outside)設為結束條件。

機器人將成為指定狀態時,即可將其判定為符合位置結束條件。

進入平面的狀態:

位於平面的+Z方向的狀態。

画像

PlaneRelativeOrg 設定表示平面原點偏移量時,作為參考使用的座標系方向。

左下圖為設定Base的範例。

依基礎座標系指定相對距離。

此為PlaneRelativeZ設定負值的範例。

右下圖為設定Tool的範例。

依工具座標系指定相對距離。

此為PlaneRelativeZ設定正值的範例。

本地或工具座標系僅可在方向及原點位置不受影響的情況下使用。

画像

由於需在機器人動作方向設定做為結束條件的位置,因此一般會設定與力覺引導序列的ForceOrient相同的數值。

PlaneRelativeX

PlaneRelativeY

PlaneRelativeZ

設定從目前位置到平面原點的各方向偏移量。

方向將為PlaneRelativeOrg指定的座標系方向。

PlaneRelativeOrient 根據平面方向設定座標系。

左下圖為設定Base的範例。

無論機器人在力覺引導物件起始點的方向,平面參考方向皆與基礎座標系一致。

右下圖為設定Tool的範例。

平面參考方向會沿機器人在力覺引導物件起始點的方向改變。

画像

由於與機器人運動方向垂直的平面將作為結束條件,因此一般會設為與力覺引導序列的ForceOrient相同的數值。
PlaneAxes

設定平面方向。

依據PlaneRelativeOrient指定的座標系,將平面設為PlaneAxes設定的方向。

下圖為Base由PlaneRelativeOrient設定時的範例。

左圖: PlaneAxes指定的XY右圖: PlaneAxes指定的YZ。

画像

一般會設定與機器人運動方向垂直的平面方向。
PlaneRelativeRobotLocal

設定PlaneRelativeOrg或PlaneRelativeOrient為Local時使用的本地座標系編號。

一般來說,設定與力覺引導序列RobotLocal相同的數值。

Step 8. 設定I/O相關結束條件
設定與I/O結束條件相關的屬性(IOCheckEnabled, IOCheckInputBit, IOCheckInputStatus)。

屬性
說明、設定指南
IOCheckEnabled

此屬性可設定是否啟用I/O的結束條件。

True:要啟用I/O相關的結束條件時

IOCheckInputBit 設定作為結束條件監控的輸入位元。
IOCheckInputStatus

設定要作為結束條件的輸入位元狀態。

若IOCheckInputBit指定的輸入位元成為IOCheckInputStatus指定的狀態,即可將其判定為符合結束條件。