ID : 4944
AddPathPoint
功能
在路径数据中追加路径点。
格式
AddPathPoint 路径编号, 路径点 [, 工具坐标 [, 工件坐标]]
指定项目
- 路径编号
- 通过整数型数据指定追加的路径编号(1~20)。
- 路径点
- 以位置数据指定要添加的路径点。可指定位置型、连接型、齐次转换型数据。
- 工具坐标
- 以位置型数据指定检查要添加的路径点是否在机器人的可动范围内所用的工具坐标的各要素(X,Y,Z,Rx,Ry,Rz),或者以-1~63的整数型数据指定工具坐标系编号。
通过位置型数据指定时,Fig要素被忽略。
“-1”表示当前的工具编号,0~63为工具坐标系编号。可省略。省略时为“-1”(当前的工具编号)。 - 工件坐标
- 以位置型数据指定检查要添加的路径点是否在机器人的可动范围内所用的工件坐标的各要素(X,Y,Z,Rx,Ry,Rz),或者以-1~7的整数型数据指定工件坐标系编号。
通过位置型数据指定时,Fig要素被忽略。
“-1”表示当前的工件编号,0~7为工件坐标系编号。可省略。省略时为“-1”(当前的工件编号)。
从Ver.2.7.*以后可以指定工具坐标及工件坐标。
解说
在路径数据中追加路径点。
指定路径编号的路径数据上已经存在路径点时在该数据后面追加。
如果指定工具坐标、工件坐标,用其检查要添加的路径点是否在机器人的可动范围内。没有指定时,通过现在的工具坐标、工件坐标进行检查。
在使用多功能教导器进行跟踪的路径点设定的作业中,可将在此使用的工件坐标登录到P型变量。详细内容请参照传送带跟踪使用说明书的“[传感器跟踪]自由曲线插补的设置步骤”或者“[视觉跟踪]自由曲线插补的设置步骤”。
通过此指令追加的路径点保存在操作用存储器中,无法保存至保存用存储器,因此,切断控制器电源前可以使用,但再次接通电源后不能使用。
注意事项
- 可通过使用条件设定TakeArm时是否清空路径点数据。默认为不清空。(和RC7M控制器的不同点)
- 通过此指令追加路径点时,如果发生错误并再次启动程序,则不清空之前追加的路径点而将进一步追加。为防止该情况发生,在使用该指令之前,使用ClrPathPoint或LoadPathPoint进行初始化。
- 以连接型数据指定路径点,指定了工具坐标、工件坐标时,根据该工具坐标、工件坐标计算位置型数据,保存位置型数据。不指定工具坐标、工件坐标时,根据执行时的当前的工具坐标、工件坐标计算位置型数据,保存位置型数据。
应用示例
#Define Home P(300,0,300,180,0,180,-1)
#Define PartsNum I[10]
#Define BasePathNum 10
Sub Main
Dim PathNum As Integer '各选件号的路径数据
Dim Pos As Position
Dim n As Integer
LoadPathPoint BasePathNum '初始化(返回基本路径数据)
PathNum = Int(PartsNum / 1000) '根据选件号设定路径编号(第4位)
For n = 1 To GetPathPointCount(PathNum)
Pos = GetPathPoint(PathNum, n) '读取取选件号的路径点数据
AddPathPoint BasePathNum, Pos '在基本路径上追加路径点
Next
TakeArm
Move S, BasePathNum, Speed = Mps(150) '在自由曲线插补间移动机器人
Move P, Home
End Sub
ID : 4944