Skip to main content

4.3.1. 基于传感器的控制测试

4.3.1. 基于传感器的控制测试

 

在控制测试菜单中设置好控制测试参数之后,需要通过功能 MSTtest 和系统变量 _MSTRef 对基于传感器的控制测试 (SBMT) 进行编程。

 

 

410 控制测试功能和变量

MSTtest

解释

该功能根据具体情况建立分支。

语法

MSTtest G=<组号>,然后调出<程序号>

参数

组号

控制测试组编号 (1~3)

程序号

MST 程序号

示例

MSTtest G=1,然后调出 10

_MSTRef

解释

该变量指控制测试菜单中配置的基准位置。

语法

_MSTRef<组号>

示例

P1=_MSTRef1

 

 

411 控制测试程序

MST 程序

解释

- 示教基准位置和接近位置

- 接近位置向基准位置移动,以免碰撞

- 基准位置指控制测试菜单中配置的数值

- 基准位置应通过参数 _MSTRef 分配给“姿势”变量

- 为安全起见,基准位置的移动速度应足够慢

- 设置机器人达到基准位置后判断传感器信号的延迟时间

示例

P1=_MSTRef1

位移 LS=60%A=1T=1:接近位置

位移 LP1S=5%A=0T=1:基准位置

延迟 3

位移 LS=60%A=1T=1

结束

主程序

解释

- 在主 JOB 程序中写入功能 MSTtest

- MSTtest 会在预警时间至测试周期内调出 MST 程序。

示例

位移 LS=60%A=1T=1

位移 LS=60%A=1T=1

位移 LS=60%A=1T=1

……

 

MSTtest G=1,然后调出 10

结束

组数与 MST 程序数相同。

 

 

如果机器人控制器在基准位置未收到传感器信号,或 MSTtest 在测试周期内未发挥作用,就会触发 STO。机器人可能会在最大限制时间内保持运动。