Forces狀態
應用項目
力覺監控物件FM#
註解
傳回合力的資料。
用途
FGet Object.Forces, rArray()
Object
物件名稱
物件指定為FM(數值)或FM(標籤)。rArray
定義屬性數值的元素數為8以上的實數變數陣列
數值
rArray()
元素編號 | 元素編號常數 |
---|---|
0 | FG_FX |
1 | FG_FY |
2 | FG_FZ |
3 | FG_TX |
4 | FG_TY |
5 | FG_TZ |
6 | FG_FMAG |
7 | FG_TMAG |
詳細說明
Forces傳回由CoordinateSystem指定的指定力覺座標系資料。
由於此命令會擷取目前的數值,因此將在不使用低通濾波器的情形下擷取數值。反應使用低通濾波器的資料,可透過力覺監控或力記錄確認。
使用範例
此範例會建立力覺座標系1和2,並擷取個別合力資料。
Function Test_Forces
Real rArray1(8), rArray2(8)
FSet FCS1.Position, 0, 0, 100
FSet FCS1.Orientation, FG_TOOL
FSet FCS2.Position, 0, 0, 5
FSet FCS2.Orientation, FG_LOCAL, 1
FSet FM1.ForceSensor, 1
FSet FM1.CoordinateSystem, FCS1
FGet FM1.Forces, rArray1()
Print rArray1(FG_FX), rArray1(FG_FY), rArray1(FG_FZ), rArray1(FG_TX), rArray1(FG_TY), rArray1(FG_TZ), rArray1(FG_FMAG), rArray1(FG_TMAG)
FSet FM1.ForceSensor, 1
FSet FM1.CoordinateSystem, FCS2
FGet FM1.Forces, rArray2()
Print rArray2(FG_FX), rArray2(FG_FY), rArray2(FG_FZ), rArray2(FG_TX), rArray2(FG_TY), rArray2(FG_TZ), rArray2(FG_FMAG), rArray2(FG_TMAG)
Fend
參考
力覺監控物件FM#