一、创建一个.KL文件编写连接指令
创建一个KL文本来编写FANUC机器人socket连接指令
二、KAREL指令代码
fanuc机器人karel编辑器编辑的karel代码如下:
PROGRAM SM_CON
%COMMENT = 'SOCKET连接'
%STACKSIZE = 4000 --堆栈大小
%INCLUDE klevccdfVAR
status,data_type,int_val :INTEGER
str_input,str_val :STRING[20]
use_file :FILE
rel_val :REALBEGINGET_TPE_PRM(1,data_type,int_val,rel_val,str_val,status)--获取TP程序传入的参数str_input = str_val + ':'MSG_CONNECT(str_input,status)--连接SOCKETIF (status <> 0) THENPOST_ERR(status,'',0,2)ENDIFSET_FILE_ATR(use_file,ATR_IA)--交互型文件SET_FILE_ATR(use_file,ATR_READAHD)--设置缓存大小OPEN FILE use_file('RW',str_input)status = IO_STATUS(use_file)--获取文件状态IF (status <> 0) THENCLOSE FILE use_fileCLR_IO_STAT(use_file)--清空文件状态WRITE TPDISPLAY(CHR(128),CHR(137))WRITE TPDISPLAY('连接失败',CR)OPEN FILE use_file('RW',str_input)ENDIFWRITE use_file('连接成功')CLOSE FILE use_file
END SM_CON
三、测试SOCKET通讯
在机器人示教器上创建一个TP程序,调用KAREL程序,传入需要连接的服务器/客户端的端口,测试连接,下图用服务器端口S3测试。
运行改程序测试SOCKET通讯,连接成功后机器人会向调试助手发送通讯成功的提示