kawasaki_robot_udp_tcp
1.0.0
Dieses Repository enthält Beispielcode, der zeigt, wie eine UDP-Kommunikation zwischen einem PC und einem Kawasaki-Roboter hergestellt wird.
robot_script.as
: Kawasaki-Roboter-AS-Sprachskript zum Empfangen von UDP-Nachrichten.send_message.py
: Python-Skript zum Senden von UDP-Nachrichten an den Roboter.robot_tcp_communication.as
: Kawasaki-Roboter-AS-Sprachskript zum Herstellen einer TCP-Verbindung, zum Empfangen von Daten und zum Schließen der Verbindung.robot_tcp_communication.py
: Python-Skript zum Senden von TCP-Nachrichten an den Roboter. robot_script.as
ein.ROBOT_IP
und ROBOT_PORT
in send_message.py
damit sie der Konfiguration Ihres Roboters entsprechen. Führen Sie das Kawasaki-Roboterskript robot_script.as
auf dem Roboter aus.
Führen Sie das Python-Skript send_message.py
auf Ihrem PC aus, um Nachrichten an den Roboter zu senden:
python send_message.py
Der Roboter empfängt die Nachricht und druckt sie auf seiner Konsole aus.
robot_tcp_communication.as
auf dem Roboter aus.connect_to_pc
: Stellt die TCP-Verbindung zum PC her.receive_data
: Empfängt kontinuierlich Daten vom PC und druckt sie aus.close_connection
: Schließt die TCP-Verbindung. robot_tcp_communication.as
. PROGRAM connect_to_pc()
; Configuration for connection using TCP .
; This scripts are created by Coder Shiyar
timeout_open = 60
pc_ip [ 1 ] = 192
pc_ip [ 2 ] = 168
pc_ip [ 3 ] = 0
pc_ip [ 4 ] = 2 ; PC 's IP address
pc_port = 10001
error_count = 0
connect:
; Start timer
TIMER (2) = 0
; Attempt to connect to the PC
TCP_CONNECT socket_id, pc_port, pc_ip[1], timeout_open
; Check if connection is successful
IF socket_id < 0 THEN
error_count = error_count + 1
IF error_count >= 5 THEN
PRINT "Client Communication with PC has failed"
ELSE
PRINT "TCP_CONNECT error id = ", socket_id, ", error count = ", error_count
GOTO connect
END
ELSE
PRINT "TCP_CONNECT OK id = ", socket_id, ", with time elapsed = ", TIMER (2)
END
.END
.PROGRAM receive_data()
; Loop to receive data continuously
WHILE TRUE DO
num_bytes = 10
max_length = 10
timeout_receive = 60
recv_result = 0
; Receive data from the PC
TCP_RECV recv_result, socket_id, $receive_buffer[1], num_bytes, timeout_receive, max_length
; Check if data reception is successful
IF recv_result < 0 THEN
PRINT "TCP_RECV error in RECV", recv_result
$receive_buffer[1] = "000"
ELSE
IF num_bytes > 0 THEN
; Print received data
FOR i = 1 TO num_bytes
PRINT "RecBuff[", i, "] = ", $receive_buffer[i]
; Check for specific messages
IF $receive_buffer[1] == "1" THEN
PRINT "IT IS 1"
END
IF $receive_buffer[1] == "2" THEN
PRINT "IT IS 2"
END
END
ELSE
$receive_buffer[1] = "000"
recv_result = -1
END
END
END
.END
.PROGRAM close_connection()
; Close the connection to the PC
close_result = 0
IF socket_id >= 0 THEN
TCP_CLOSE close_result, socket_id
END
; Check if the connection is closed successfully
IF close_result < 0 THEN
PRINT "TCP_CLOSE error id = ", socket_id
ELSE
PRINT "TCP_CLOSE OK id = ", socket_id
END
.END