1.  簡(jiǎn)介

30001端口，可用于獲取機器人的各種狀態(tài)及數據，機器人會(huì )以10HZ（100ms）的頻率向30001端口發(fā)送機器人的狀態(tài)數據，還可以往30001端口發(fā)送腳本命令，運動(dòng)指令，控制機器人運動(dòng)等。（FB1網(wǎng)口）

2.  發(fā)送腳本控制機器人

外部設備可以往30001直接發(fā)送機器人腳本，機器人處于遠程模式，機器人就會(huì )運動(dòng)。

（點(diǎn)擊下圖右上角的Elite logo，可以進(jìn)入設置界面）

遠程控制選擇啟用

將機器人切換為遠程控制模式

用戶(hù)可以在socket調試助手中，發(fā)送以下代碼進(jìn)行測試

外部發(fā)送的腳本格式如下：即def開(kāi)頭，end結尾（end后加入換行）。中間內容為機器人支持的腳本。

def a():

movej([-3.14,-1.57,-1.57,-1.57,1.57,0],a=1.4,v=0.5,t=0,r=0)

movej([-1.57,-1.57,-1.57,-1.57,1.57,0],a=1.4,v=0.5,t=0,r=0)

end

也可使用如下代碼，發(fā)送帶有函數調用的腳本

def test(): # 最外層def必須增加end\n結尾

# 內部是正常的python語(yǔ)法

def mov():

movej([0.57636,-1.01469,-2.04816,-1.29723,1.5708,-0],a=1.4,v=1.05,t=0,r=0)

a = "hello cs"

if a == "hello cs":

mov()

end

3.  數據接收及解析

接收機器人狀態(tài)數據

該端口還會(huì )以10Hz的頻率持續不斷地將機器人的狀態(tài)數據以固定格式往外發(fā)送。數據格式大體如下：

機器人狀態(tài)報文格式

詳細每一段子報文的內容請參考《CS_用戶(hù)手冊_機器人狀態(tài)報文.xlsx》

機器人狀態(tài)數據報文主題結構包含報文頭、機器人模式數據子報文、關(guān)節數據子報文、笛卡爾數據子報文、機器人配置數據子報文、機器人主板信息子報文、機器人附加信息子報文、內部使用子報文、機器人工具數據子報文、機器人安全狀態(tài)子報文、機器人工具通訊子報文、內部使用子報文等內容.

每一段子報文內的數據長(cháng)度、格式都是嚴格定義的，用戶(hù)讀取時(shí)按需擇取對應數據段按照指定格式進(jìn)行數據解析。

以下使用Python對機器人配置數據子報文解析為例說(shuō)明。

程序流程如下：

4.  示例

參考代碼：

from robot import *

import argparse

import logging

import time

import numpy as np

from math import *

parser = argparse.ArgumentParser()

#以下IP地址需要修改

parser.add_argument('--host', default='192.168.1.200', help='name of host to connect to (localhost)')

parser.add_argument('--port', type=int, default=30001, help='port number (30001)')

parser.add_argument('--samples', type=int, default=100, help='number of samples to record')

args = parser.parse_args()

robot = Robot('RobotStateMessage.xlsx', 'v2.1.0')

robot.connect(args.host, args.port)

sample_count = args.samples

while sample_count > 0:

data = robot.get_data()

if data == None:

logging.warning("Data is None")

continue

print(" {:=^50s}".format(""))

print("基坐標X、Y、Z")

print("tcp_x: "+('{:.2f}'.format(data.tcp_x*1000)))

print("tcp_y: "+('{:.2f}'.format(data.tcp_y*1000)))

print("tcp_z: "+('{:.2f}'.format(data.tcp_z*1000)))

#print("actual_joint : ")

print("RX、RY、RZ\x20關(guān)節單位\x20°")

print("RX: " + ('{:.3f}'.format(degrees(data.rot_x))))

print("RY: " + ('{:.3f}'.format(degrees(data.rot_y))))

print("RZ: " + ('{:.3f}'.format(degrees(data.rot_z))))

print(" {:=^50s}".format(""))

print("關(guān)節位置\x20關(guān)節單位\x20°")

print("一軸、基座\x20"'{:.2f}'.format(degrees(data.actual_joint0)))

print("二軸、肩部\x20"'{:.2f}'.format(degrees(data.actual_joint1)))

print("三軸、肘部\x20"'{:.2f}'.format(degrees(data.actual_joint2)))

print("四軸、手腕1\x20"'{:.2f}'.format(degrees(data.actual_joint3)))

print("五軸、手腕2\x20"'{:.2f}'.format(degrees(data.actual_joint4)))

print("六軸、手腕3\x20"'{:.2f}'.format(degrees(data.actual_joint5)))

print(" {:=^50s}".format(""))

#機器人是否上電：上電為true，未上電為false

print("機器人是否上電",data.is_robot_power_on)

#print(data.is_robot_power_on)

print("是否處于機器人急停和系統急停",data.is_robot_protective_stopped)

#print(data.is_robot_protective_stopped)

print("是否處于保護停止",data.is_robot_protective_stopped)

#print(data.is_robot_protective_stopped)

print("程序是否處于運行態(tài)",data.is_program_running)

#print(data.is_program_running)

print("程序是否暫停",data.is_program_paused)

#print(data.is_program_paused)

print("機器人模式",data.get_robot_mode)

#print(data.get_robot_mode)

print("機器人控制模式",data.get_robot_control_mode)

print("0未確認、1確認安全、2初始化、3下點(diǎn)、4上電、5空閑、6反向驅動(dòng)、7正在運行、8升級固件、9等待編碼器標定")

#print(data.get_robot_control_mode)

print("機器人速度模式",data.get_robot_speed_mode)

#print(data.get_robot_speed_mode)

print("機器人是否處于系統報警狀態(tài)",data.is_robot_system_in_alarm)

#print(data.is_robot_system_in_alarm)

print("主板是否在縮減模式",data.is_robot_in_reduced_mode)

print("碰撞檢測模式狀態(tài)",data.is_dynamic_collision_detect_enabled)

print("工具模擬IO輸出配置",data.tool_analog_output_domain)

#print("")

#print(data.)

print(" {:=^50s}".format(""))

#print(data.actual_velocity1)弧度/秒

print("關(guān)節實(shí)際速度\x20角度/秒")

print("1軸實(shí)際速度\x20"'{:.2f}'.format(degrees(data.actual_velocity0)))

print("2軸實(shí)際速度\x20"'{:.2f}'.format(degrees(data.actual_velocity1)))

print("3軸實(shí)際速度\x20"'{:.2f}'.format(degrees(data.actual_velocity2)))

print("4軸實(shí)際速度\x20"'{:.2f}'.format(degrees(data.actual_velocity3)))

print("5軸實(shí)際速度\x20"'{:.2f}'.format(degrees(data.actual_velocity4)))

print("6軸實(shí)際速度\x20"'{:.2f}'.format(degrees(data.actual_velocity5)))

print(" {:=^50s}".format(""))

print("關(guān)節力矩")

print("1關(guān)節力矩\x20"'{:.2f}'.format(data.torques0))

print("2關(guān)節力矩\x20"'{:.2f}'.format(data.torques1))

print("3關(guān)節力矩\x20"'{:.2f}'.format(data.torques2))

print("4關(guān)節力矩\x20"'{:.2f}'.format(data.torques3))

print("5關(guān)節力矩\x20"'{:.2f}'.format(data.torques4))

print("6關(guān)節力矩\x20"'{:.2f}'.format(data.torques5))

print(" {:=^50s}".format(""))

print("模擬IO0輸出值.\x2002-0.004單位A")

print(data.standard_analog_output_value0,"A")

print(data.standard_analog_output_value1,"A")

print("工具模擬IO輸出配置",data.tool_analog_output_domain)

print("工具輸出電壓數值",data.tool_output_voltage,"V")

print("工具輸出電流", data.tool_current,"A")

#print(" {:=^50s}".format(""))

sample_count -= 1

time.sleep(2)

5.  常見(jiàn)問(wèn)題解答

5.1.問(wèn)：端口連接不上，連接沒(méi)反應

答：檢修一下網(wǎng)絡(luò )是不是沒(méi)有連接上，可以在示教器網(wǎng)絡(luò )設置頁(yè)面查看，或者使用電腦ping一下看看能否ping通，網(wǎng)口是否正常連接的FB1口

5.2.問(wèn)：向端口發(fā)送運動(dòng)指令機器人不運動(dòng)或者報錯

答：檢查一下所發(fā)送的點(diǎn)位數據是否正常，并不是任意一組數據機器人都能執行，需要該數據在機器人工作范圍內，并且有正常的解。另外數據的單位為米跟弧度。