| typora-root-url |
|---|
./picture |
English version of the README -> please click here
Dobot TCP-IP-CR-Python-V4 二次开发api接口 （ TCP-IP-CR-Python V4 README ）
TCP-IP-CR-Python-V4 是为 Dobot 公司旗下基于TCP/IP协议的Python的封装设计的软件开发套件。它基于 Python 语言开发，遵循Dobot-TCP-IP控制通信协议，通过Socket与机器终端进行Tcp连接， 并为用户提供了易用的Api接口。 通过TCP-IP-CR-Python-V4 ，用户可以快速地连接Dobot机器并进行二次开发, 实现对机器的控制与使用。
-
电脑可用网线连接控制器的网口，然后设置固定 IP，与控制器 IP 在同一网段下。也可无线连接控制器。
有线连接时连接LAN1：ip为192.168.5.1 , 有线连接时连接LAN2：ip为192.168.200.1, 无线连接：ip为192.168.9.1
-
尝试 ping 通控制器 IP，确保在同一网段下。
-
安装Python环境，Python环境安装请参考 Python安装指南
python环境配置numpy： pip install numpy
-
此API接口与Demo适用于CR-V4系列的V4及以上控制器版本
| 版本 | 修改日期 |
|---|---|
| v1.0.0.0 | 2023-11-20 |
由于基于TCP/IP的通讯具有成本低、可靠性高、实用性强、性能高等特点；许多工业自动化项目对支持TCP/IP协议控制机器人需求广泛，因此Dobot机器人将设计在TCP/IP协议的基础上，提供了丰富的接口用于与外部设备的交互；
机器状态等级：
1.报错状态为第一优先级，如机器人报错且未上使能，则状态返回为报错状态
2.下电状态为第二优先级，如机器人未上电，未上使能，则状态返回未上电状态
3.碰撞状态为第三优先级，如机器人处于碰撞，脚本暂停，则状态返回碰撞状态
4.开抱闸状态为第四优先级，如机器人开抱闸，未使能状态，则状态返回开抱闸状态
其余状态根据实际情况反馈。
端口反馈信息：
29999服务器端口通过一发一收的方式负责接收一些设置以及运动控制相关的指令
30004服务器端口(以下简称实时反馈端口)每8ms反馈机器人的信息
30005服务器端口每200ms反馈机器人的信息
30006端口为可配置的反馈机器人信息端口(默认为每50ms反馈)
取消30003端口
有关协议更详细的信息请查阅**《越疆TCPIP控制协议文档6AXis-V4》**
-
从GitHub 下载或者克隆Dobot TCP-IP-CR-Python-V4 二次开发api程序
`git clone https://github.com/Dobot-Arm/TCP-IP-CR-Python-V4.git -
参考对应的 README.md 文档使用；
-
main.py: 主程序运行入口。
-
dobot_api.py：封装机器人接口，具体Api指令用法根据机器人TCP/IP远程控制方案（https://github.com/Dobot-Arm/TCP-IP-Protocol-6AXis-V4.git）自行参考和使用。
-
files：存放报警ID相关信息 ,
alarm_controller.json警告报警配置文件,alarm_servo.json伺服报警配置文件 -
PythonExample.py : 包含一些api接口指令的用法和代码示例来参考
dobot_api目录中的类说明：
| Class | Define |
|---|---|
| DobotApi | 基于tcp通信的接口类，封装了通信的基础业务 |
| DobotApiDashboard | 继承于DobotApi，实现了具体的机器人基本功能 |
| DobotApiFeedBack | 继承于DobotApi，用于实时反馈机器人的状态信息 |
| MyType | 数据类型对象，反馈机器人的状态列表 |
| alarm_controller | 警告报警配置信息 |
| alarm_servo | 伺服报警配置信息 |
DobotApi
基于tcp通信的接口类，提供对机器的tcp连接，关闭，获取ip，端口等功能， 封装了通信的基础业务。
class DobotApi:
def __init__(self, ip, port, *args):
""
if self.port == 29999 or self.port == 30004:
try:
self.socket_dobot = socket.socket()
self.socket_dobot.connect((self.ip, self.port))
"" DobotApiDashboard
继承于DobotApi， 能发送控制及运动指令给机器人。实现了具体的机器人基本功能。
class DobotApiDashboard(DobotApi):
"""
Define class dobot_api_dashboard to establish a connection to Dobot
"""
def EnableRobot(self,*dynParams):
"""
Enable the robot
"""
self.send_data(string)
return self.wait_reply()
"""DobotApiFeedBack
继承于DobotApi， 实时反馈机械臂状态信息。
class DobotApiFeedBack(DobotApi):
def __init__(self, ip, port, *args):
super().__init__(ip, port, *args)
self.__MyType = []
self.__Lock = threading.Lock()
feed_thread = threading.Thread(target=self.recvFeedData) # 机器状态反馈线程
feed_thread.daemon = True
feed_thread.start()
"""
MyType
数据类型对象
MyType=np.dtype([('len', np.int16, ),
('Reserve', np.int16, (3,) ),
('digital_input_bits', np.int64, ),
('digital_outputs', np.int64, ),
('Reserve3', np.int8, (24,)),
])
""具体使用详情请查看代码Demo示例
-
Tcp连接问题：
29999端口为单客户端连接 ，只允许一个客户端连接；
30004 30005 30006端口可以多客户端同时连接；
29999端口有机器人模式限制，开放前需要先将机器人设置为TCP模式，否则指令发送后无法响应并返回"Control Mode Is Not Tcp"，30004、30005、30006实时反馈端口无模式限制；
-
要获取机器人的状态， 可监测RobotMode()返回值。
-
控制器启动阶段为初始化状态，返回1；
-
机器人状态不为0或1时，机器人初始化完成；
-
机器下电状态，返回3；
-
初始化完成但未上使能为未使能状态，返回4；
-
机器使能空闲状态，返回5，代表可正常接收运动指令；
-
movj(运行相关指令)、脚本运行及其他队列指令统一为运行状态，返回7；
-
movJog（点动）为单次运动状态，返回8；无上电状态；
| 模式 | 描述 | 备注 |
| ---- | ---------------------- | ------------------------------- |
| 1 | ROBOT_MODE_INIT | 初始化状态 |
| 2 | ROBOT_MODE_BRAKE_OPEN | 抱闸松开 |
| 3 | ROBOT_MODE_POWEROFF | 本体下电状态 |
| 4 | ROBOT_MODE_DISABLED | 未使能(抱闸未松开) |
| 5 | ROBOT_MODE_ENABLE | 使能(空闲) |
| 6 | ROBOT_MODE_BACKDRIVE | 拖拽 |
| 7 | ROBOT_MODE_RUNNING | 运行状态（含脚本和TCP队列运行） |
| 8 | ROBOT_MODE_SINGLE_MOVE | 单次运动状态(点动) |
| 9 | ROBOT_MODE_ERROR | 错误状态 |
| 10 | ROBOT_MODE_PAUSE | 暂停状态 |
| 11 | ROBOT_MODE_COLLISION | 碰撞状态 |
-
不同机器状态响应指令
*错误状态可执行指令：ClearError()、GetErrorID()、EmergeStop()、RobotMode()，其余指令均拒绝指令，返回-2；
*急停状态可执行指令：ClearError()、GetErrorID()、EmergeStop()、RobotMode()，其余指令均拒绝指令，返回-3；
*下电状态可执行指令：ClearError()、GetErrorID()、EmergeStop()、RobotMode()，PowerOn()，其余指令均拒绝指令，返回-4；
*TCP指令除必要的影响到机器人状态的指令外（EnableRobot()、PowerOn()），其余均为立即返回指令，指令返回仅代表成功发送，不代表执行完成；
-
坐标系问题
进入TCP/IP模式默认会将用户/工具坐标系设置为0，0，退出TCP/IP模式自动恢复至上位机设置的用户/工具坐标系索引值；
全局坐标：User()、Tool()指令设置的是全局坐标系，设置后对所有指令均生效；
局部坐标：运动指令中带的user/tool可选参仅在当前运动指令生效，执行完当前指令后恢复至全局坐标系；
-
算法允许的队列深度为64，可同时连续处理64条队列指令，若一直向端口发送队列指令而超出队列深度，端口不会断连，指令接口会返回-1，指令不会执行
-
队列指令为立即返回指令，接口返回成功仅代表发送成功，不代表执行完毕。若判断执行完毕，则需要结合CommandID和RobotMode来综合判断
-
伺服运行时间代表上使能后的累计时间，控制器开机时间代表控制器开机后的时间（正常上电），因此控制器开机时间总要大于伺服运行时间的
-
碰撞状态不属于错误，GetErrorID()中没有碰撞的错误返回，可通过RobotMode()查询碰撞状态，返回11；ClearError()可清除碰撞状态
-
发生碰撞后正常发送清错指令，清除碰撞状态即可重新运行，不需要重新上使能
-
切换TCP/IP模式后会默认将速度/加速度/用户、工具坐标系参数设置为默认值，无需调用EnableRobot()指令进行默认参数设置
-
Tcp队列指令返回值仅表示指令参数和语法是否符合规范，不表示指令是否成功执行。TCP队列指令发送后即返回，返回0仅代表正常发送，不表示可成功执行。
-
Tcp指令参数类型/数量错误会直接报警，不会补0处理，指令不会下发至算法。
-
触发急停信号后，机器人默认进行运动停止，若停止过程超过500ms还未停止运动，则执行下电动作；否则不进行下电；一般情况下机器人急停后不下电
-
设置默认网关后，数值默认网关数据会保存，重启后数值不会更改
-
上使能指令仅执行使能动作，无其余参数设置，不会清除运动学参数和坐标系参数。
-
Pause()、Continue()指令对脚本运行生效，运动指令（队列相关）也生效，调用Pause()指令后机器人进入暂停状态，算法队列暂停；可使用Continue()指令继续运行队列指令。MovJog(点动)指令属于单次运行状态，不可暂停和继续
-
目前的TCP的指令之间不支持插入无关的字符 可以使用如下两种格式来写 ① MovJ()MovJ()MovJ()
② MovJ() MovJ() MovJ()
- Dobot-Demo 实现Tcp对机器的控制等交互，分别对控制端口，反馈端口进行tcp连接，通过机器运动指令完成状态来进行下发指令，且对机器异常状态进行处理等功能。
- 主线程：分别对机器控制端口，运动端口，反馈端口进行连接。给机器使能，MovL移动指令等动作
- 反馈状态线程：实时反馈机器的状态信息
- 机器运动线程： 给机器下发运动指令
运动指令到位信号：
队列指令为立即返回指令，接口返回成功仅代表发送成功，不代表执行完毕。若判断执行完毕，则需要结合
-
当前CommandID大于下发运动队列指令的CommandID，则表示下发队列指令已完成。
-
当前CommandID等于下发运动指令的CommandID，且机器状态RobotMode指令返回值为5，则表示下发队列指令已完成。
- 异常处理线程：对机器异常状态进行判断和处理动作
Demo运行的操作步骤时序如下图所示 ：
-
从GitHub 获取越疆dobot TCP-IP-CR-Python-V4 二次开发Api程序
`git clone https://github.com/Dobot-Arm/TCP-IP-CR-Python-V4.git -
通过LAN1网口-连接机器端，设置本机机器IP地址为192.168.5.X 网段
控制面板>>网络>> Internet>>网络连接
选择连接的以太网 >> 点击右键 >> 属性 >> Internet协议版本(TCP/IPV4)
修改ip地址为192.168.5.X网段IP
-
连接上位机DobotStudio Pro，连接机器，把机器模式切换至TCP/IP模式
-
运行程序，需要检测搜索到动态库，在VsCode/PyCharm中打开整个目录，直接运行 main.py。
Tcp连接：自主选择连接机械臂的端口 ， 与机械臂建立连接
class DobotDemo:
def __init__(self, ip):
self.ip = ip
self.dashboardPort = 29999
self.feedPortFour = 30004
# self.feedPortFour = 30005
# self.feedPortFour = 30006
self.dashboard = None
... ...实例化对象： 下发端口类DobotApiDashboard和信息反馈类DobotApiFeedBack
def start(self):
self.dashboard = DobotApiDashboard(self.ip, self.dashboardPort)
self.feedFour = DobotApiFeedBack(self.ip, self.feedPortFour)
enableState = self.parseResultId(self.dashboard.EnableRobot())
if enableState[0] != 0:
print("使能失败: 检查29999端口是否被占用)")
return
print("使能成功:)")
... ...控制机械臂运动： 下发运行指令，控制机械臂运动
point_a = [-90, 20, 0, 0, 0, 0]
point_b = [90, 20, 0, 0, 0, 0]
while True:
while True:
p2Id = self.RunPoint(point_a)
if p2Id[0] == 0: # 运动指令返回值正确
self.WaitArrive(p2Id[1]) # 传入运动指令commandID ,进入等待指令完成
break
else:
sleep(5) # 运动指令返回值错误(如非tcp模式等) 休眠5s后继续运行
# 封装机械臂运动功能，下发运动指令，返回机械臂运行结果
def RunPoint(self, point_list: list):
recvmovemess = self.dashboard.MovJ(
point_list[0], point_list[1], point_list[2], point_list[3], point_list[4], point_list[5], 1)
print("Movj", recvmovemess)
commandArrID = self.parseResultId(recvmovemess) # 解析Movj指令的返回值
return commandArrID
... ... ... ...
运行指令完成标志： 等待机械臂运动指令完成 ，类似与 Sync功能。
# 通过CommandID和robotMode来判断
def WaitArrive(self, p2Id):
while True:
while not self.__robotSyncBreak.is_set():
self.__globalLockValue.acquire() #
if self.feedData.robotEnableStatus:
if self.feedData.robotCurrentCommandID > p2Id:
self.__globalLockValue.release()
break
else:
isFinsh = (self.feedData.robotMode == 5)
if self.feedData.robotCurrentCommandID == p2Id and isFinsh:
self.__globalLockValue.release()
break
self.__globalLockValue.release()
sleep(0.01)
self.__robotSyncBreak.clear()
break解析返回信息函数： 解析下发指令后，机械臂的返回信息。
#解析信息，返回列表
def parseResultId(self, valueRecv):
if valueRecv.find("Not Tcp") != -1: # 通过返回值判断机器是否处于tcp模式
print("Control Mode Is Not Tcp")
return [1]
recvData = re.findall(r'-?\d+', valueRecv)
recvData = [int(num) for num in recvData]
# 返回tcp指令返回值的所有数字数组
if len(recvData) == 0:
return [1]
return recvData
# 通过判断列表返回值来判断机械臂状态（见下表）
parseResultId函数：解析所有的数字
# 0,{1846},MovJ(joint={90,20,0,0,00,00}); [0,1846,90,20,0,0,0,0]
# 0,{},clearerror() [0]
# 0,{[[30,132],[],[],[],[],[],[]]},geterrorid(); [0,30,132]
# Control Mode Is Not Tcp [1]
# -1,{},MovJ(joint={90,20,0,0,00,00}); [-1,90,20，...]
# -2,{},MovJ(joint={90,20,0,0,0,0}); [-2,90,20，...]
# -30001,{},MovJ(joi={90,20,0,0,0,0}); [-30001,90,20，...] | 返回值 | 列表下标 | list[0] | list[1] | list[...] |
|---|---|---|---|
| 0 | 指令下发成功 | - | - |
| 1 | 机械臂非TCP模式 | - | - |
| 2 | 其它程序异常 | - | - |
| -1 | 没有执行成功 | - | - |
| -2 | 当前处于错误状态拒绝执行指令 | - | - |
| -3 | 当前处于急停拍下状态拒绝执行指令 | - | - |
| -4 | 当前处于下电状态拒绝执行指令 | - | - |
| -10000 | 命令错误 | - | - |
| -20000 | 参数数量错误 | - | - |
| -30001 | 第一个参数的参数类型错误 | - | - |
| -30002 | 第二个参数的参数类型错误 | - | - |
| ... ... | |||
| -40001 | 第一个参数的参数范围错误 | - | - |
| ... ... | |||
| -50001 | 可选参数第一个参数的参数类型错误 | - | - |
| ... ... | |||
| -60001 | 可选参数第一个参数的参数范围错误 | - | - |
| ... ... |
list[1]及list[n]值为特殊指令的返回值
# 通过判断列表返回值来判断机械臂状态
# 0,{1846},MovJ(joint={90,20,0,0,00,00}); list[1]为commandArrID 1846
# 0,{[[30,132],[],[],[],[],[],[]]},geterrorid(); list[1]，list[2]为机械臂告警码获取机械臂信息： 获取反馈端口机械臂状态信息
... ...
def GetFeed(self):
while True:
feedInfo = self.feedFour.feedBackData()
if hex((feedInfo['test_value'][0])) == '0x123456789abcdef':
self.__globalLockValue.acquire()
# 自主添加所需机械臂反馈的数据 详情查 **MyType**
# .......................................................
self.feedData.robotErrorState = feedInfo['error_status'][0]
self.feedData.robotEnableStatus = feedInfo['enable_status'][0]
self.feedData.robotMode = feedInfo['robot_mode'][0]
self.feedData.robotCurrentCommandID = feedInfo['currentcommandid'][0]
# .......................................................
self.__globalLockValue.release()
sleep(0.004)
... ...
# 机器状态反馈线程
feed_thread = threading.Thread(
target=self.GetFeed)
feed_thread.daemon = True
feed_thread.start()监控机器状态： 监控机械臂异常状态和机械臂清错功能
def ClearRobotError(self):
# 读取控制器和伺服告警码
dataController, dataServo = alarmAlarmJsonFile()
while True:
self.__globalLockValue.acquire() # robotErrorState加锁
if self.feedData.robotErrorState:
geterrorID = self.parseResultId(self.dashboard.GetErrorID())
if geterrorID[0] == 0:
for i in range(1, len(geterrorID)):
alarmState = False
# 读取控制器告警码
for item in dataController:
if geterrorID[i] == item["id"]:
print("机器告警 Controller GetErrorID",
i, item["zh_CN"]["description"])
alarmState = True
break
if alarmState:
continue
# 读取伺服告警码
for item in dataServo:
if geterrorID[i] == item["id"]:
print("机器告警 Servo GetErrorID", i,
item["zh_CN"]["description"])
# 是否对机械臂进行清错操作
choose = input("输入1, 将清除错误, 机器继续运行: ")
... ...常见问题：
问题一： ModuleNotFoundError : Nomode name 'numpy'
解决方法： 未安装numpy环境， 安装numpy pip install numpy。
问题二： Connection refused, IP:Port has been occupied
解决方法： 检查机器29999端口是否已经被占用。
问题三： Demo机器输出如下状态
| 机器输出异常 | 机器状态 |
|---|---|
| Command execution failed | 没有执行成功 |
| The robot is in an error state | 机器错误状态 |
| The robot is in emergency stop state | 机器 急停状态 |
| The robot is in power down state | 机器下电状态 |
| Control Mode Is Not Tcp | 机器非TCP/IP模式 |
运行示例前请确保机器处于安全位置，防止机器发生不必要的碰撞