ABB机器人socket做server示例程序

sxj811

更多内容请点击上方 ABB机器人实战技巧 关注也可点击公众号下方 往期经典 浏览更多内容转载请先后台留言，大家一起支持原创，推动机器人使用和发展本公众号对各类ABB机器人应用，仿真，毕业设计提供技术支持，详细后台留言本公众号诚挚希望与各机器人培训机构，机器人使用单元合作，提供技术支持，详细后台留言


1.ABB机器人进行socket通讯，支持机器人做socket的client连接其他设备，也支持机器人作为socket的server，被其他设备进行连接。

2.作为server时，需要考虑其他客户端连接机器人时断开后的机器人异常处理。同时，机器人作为socket 的server，通常编写测试完成后，对应的task会被设为semi static（即开机自启动，且前台无法停止程序，除非程序出错或者再次进入controller的task设定，将task类型设为normal）

3.此处推荐Ros编写的机器人作为socket server的代码，以供参考。相关代码可以从https://github.com/ros-industrial/abb_driver/tree/kinetic-devel/rapid 下载

主程序如下：
MODULE ROS_stateServer   !程序运行模式设定为循环  LOCAL CONST num server_port := 11002;  LOCAL CONST num update_rate := 0.10;  ! broadcast rate (sec)
  LOCAL VAR socketdev server_socket;  LOCAL VAR socketdev client_socket;
PROC main()    TPWrite "StateServer: Waiting for connection.";    ROS_init_socket server_socket, server_port;    ROS_wait_for_client server_socket, client_socket;
    WHILE (TRUE) DO        send_joints;        send_status;        WaitTime update_rate;    ENDWHILE
ERROR (ERR_SOCK_TIMEOUT, ERR_SOCK_CLOSED)    IF (ERRNO=ERR_SOCK_TIMEOUT) OR (ERRNO=ERR_SOCK_CLOSED) THEN        SkipWarn;  ! TBD: include this error data in the message logged below?        ErrWrite \W, "ROS StateServer disconnect", "Connection lost.  Waiting for new connection.";        ExitCycle;  ! restart program         !程序运行模式设定为循环，这样ExitCycle可以重新从main第一行开始运行    ELSE        TRYNEXT;    ENDIFUNDOENDPROCENDMODULE

MODULEROS_socket(SYSMODULE)PROC ROS_init_socket(VAR socketdev server_socket, num port)IF(SocketGetStatus(server_socket) = SOCKET_CLOSED) SocketCreate server_socket;IF(SocketGetStatus(server_socket) = SOCKET_CREATED) SocketBind server_socket, GetSysInfo(\LanIp), port;IF(SocketGetStatus(server_socket) = SOCKET_BOUND) SocketListen server_socket;
ERRORRAISE;! raise errors to calling codeENDPROC
PROCROS_wait_for_client(VAR socketdev server_socket, VAR socketdev client_socket, \num wait_time)VARstring client_ip;VARnum time_val := WAIT_MAX;  ! default to wait-forever
IFPresent(wait_time) time_val := wait_time;
IF(SocketGetStatus(client_socket) <> SOCKET_CLOSED) SocketClose client_socket;WaitUntil(SocketGetStatus(client_socket) = SOCKET_CLOSED);
SocketAcceptserver_socket, client_socket, \ClientAddress:=client_ip, \Time:=time_val;TPWrite"Client at "+client_ip+" connected.";
ERRORRAISE;! raise errors to calling code    ! 所有的错误处理使用Raise，即调用上层统一进行错误处理ENDPROCENDMODULE