MotionLimited狀態

應用項目
力覺控制物件FC#

註解
傳回下列速度或加速限制,限制在力控制啟動時,執行的動作速度或加速。

最大關節速度 最大工具位置變化速度 最大工具方向變化速度
最大關節加速 最大工具位置變化加速 最大工具方向變化加速

用途
FGet Object.MotionLimited, iVar

  • Object
    物件名稱
    物件指定為FC(數值)或FC(標籤)。

  • iVar
    定義Int32或Int64型別的屬性數值變數

數值

位元 結果
0 最大工具位置變化速度
1 最大工具位置變化加速
2 最大工具方向變化速度
3 最大工具方向變化加速
4 J1最大關節速度
5 J1最大關節加速
6 J2最大關節速度
7 J2最大關節加速
8 J3最大關節速度
9 J3最大關節加速
10 J4最大關節速度
11 J4最大關節加速
12 J5最大關節速度
13 J5最大關節加速
14 J6最大關節速度
15 J6最大關節加速

各位元的值
0: 無限制
1: 有限制

詳細說明
傳回下列速度或加速限制,限制在力控制啟動時,執行的動作速度或加速。

最大關節速度 最大工具位置變化速度 最大工具方向變化速度
最大關節加速 最大工具位置變化加速 最大工具方向變化加速

任何在啟動力控制時,曾限制動作的項目都會變為 “1”。
這用於依動作是否受限處理或平衡。
MotionLimited狀態傳回0至65535(16進位為FFFF)的數值。因此會超出可操控含Integer型別的範圍。使用Int32或Int64型別變數。

使用範例
此為視Move動作是否受限,而進行分支處理的範例。

Function motionLimitedTest
  Int64 Result
  FSet FCS1.Orientation, FG_TOOL   ' 設定力覺座標資料

  FSet FC1.CoordinateSystem, FCS1  ' 指定力覺座標資料
  FSet FC1.Fx_Spring, 0            ' 設定Fx虛擬彈性係數
  FSet FC1.Fx_Damper, 1            ' 設定Fx虛擬阻尼係數
  FSet FC1.Fx_Mass, 10             ' 設定Fx虛擬慣性係數
  FSet FC1.Fx_Enabled, True        ' 設定Fx力控制為啟動
  FSet FC1.LimitAccelS, 5          ' 設定最大關節加速為5[mm/sec^2]
  AccelS 2                         ' 設定CP動作加速度為2[mm/sec^2]

  Move P0 FC1                      ' 在力控制啟動時的Move動作
  FGet FC1.MotionLimited, Result   ' 擷取限制結果

  If Result <> 0 Then              ' 當動作受限時
    -
    -
    -
  EndIf
  -
  -
  -
Fend

參考
力覺控制物件FC#, LimitSpeedSRJ屬性, LimitAccelSRJ屬性