通过PC驱动真实UR10e机械臂+robotiq85夹爪(Scoket)

优傲机器人UR ROBOT socket通信脚本解释 阅读详情
AI摘要

本文详细介绍了如何通过ROS和Socket通信控制UR5机械臂,包括解析机械臂状态数据,使用Python3控制85夹爪,以及集成RealsenseD405相机的过程。文章强调了Python版本对字典顺序的影响,以及在处理数据时需要注意的问题。此外,还提供了夹爪和相机的控制代码示例。

上一篇博客实现了通过ROS+moveit实现在rviz中实时控制机械臂,但是由于我的夹爪没有USB线所以无法通过现有的方法(指能白嫖到的)实现ROS中的控制。

研一的时候通过Socket通信实现过UR5的控制,而我找到了一个GitHub的大佬有通过Socket+Python3实现机械臂和夹爪控制的,并且还加了相机,白嫖党狂喜😄,本文将详细说一下该大佬的代码运行时的遇到的问题以及整个部署的实现过程。记录一下细节和踩得坑。

大佬代码连接为:GitHub - 1172534699/UR5-robotiq85-D435_control_by_python: We use TCP/IP control the UR5 robot and robotiq85 by python. And we use USB control realsenseD435 camera by python.

目录

一、UR Socket通信

二、机械臂数据的接收和解码

三、Socket控制85夹爪 

四、相机相关程序

五、代码整合-修改UR_Robot.py

六、杂谈

一、UR Socket通信

在Socket 连接中,客户端程序首先会向服务器端发送一个连接请求,服务器端会接受这个连接请求,然后通过套接字与客户端进行通信。在通信过程中,客户端和服务器端通过套接字发送和接收数据。一旦通信完成,连接就会被断开,套接字也会被关闭。基本流程如图,比较复杂,我们倒也不必深究底层实现,会用就行。就是利用socket实现数据传输。

UR提供了很多的通信端口以及对接收数据的解释具体可以查看官方提供的REMOTE CONTROL VIA TCP/IP和Overview of used ports on local host或者查看该博客UR机器人通信端口和协议对UR socket传回的数据有一个大概的认识即可。根据我们的需求对机械臂控制选用30003端口,对85夹爪的控制采用63352端口。根据机械臂版本和官方提供的excel表格以及端口选择,对于机械臂本体控制我们有下面这个表,用于后期数据的解码。

二、机械臂数据的接收和解码

参考UR机器人上位机通信-python版(一)

首先创建与UR控制器的连接,IP地址通过查看示教器设置->系统->网络即可获得

import socket
import struct
import math
import numpy as np
HOST = "192.168.56.2"    # The remote host
PORT = 30003        # The same port as used by the server
s = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
s.connect((HOST, PORT))

根据之前的数据表,我们一次会接收1116个字节数的数据,将字节所表示的名称和字节类型放入字典中:

dic= {'MessageSize': 'i', 'Time': 'd', 'q target': '6d', 'qd target': '6d', 'qdd target': '6d','I target': '6d',
      'M target': '6d', 'q actual': '6d', 'qd actual': '6d', 'I actual': '6d', 'I control': '6d',
      'Tool vector actual': '6d', 'TCP speed actual': '6d', 'TCP force': '6d', 'Tool vector target': '6d',
      'TCP speed target': '6d', 'Digital input bits': 'd', 'Motor temperatures': '6d', 'Controller Timer': 'd',
      'Test value': 'd', 'Robot Mode': 'd', 'Joint Modes': '6d', 'Safety Mode': 'd', 'empty1': '6d', 'Tool Accelerometer values': '3d',
      'empty2': '6d', 'Speed scaling': 'd', 'Linear momentum norm': 'd', 'SoftwareOnly': 'd', 'softwareOnly2': 'd', 'V main': 'd',
      'V robot': 'd', 'I robot': 'd', 'V actual': '6d', 'Digital outputs': 'd', 'Program state': 'd', 'Elbow position': '3d', 'Elbow velocity': '3d','Safety Status':'d'}

这里我踩了个大坑,由于之前一直用ros所以电脑默认的python版本是2.7,而python2中字典是无序的,所以会导致输入的字典顺序和解码是用的字典顺序不同,采用python3就没有这个问题了,如果想在python2中使用需要用到OrderedDict()类,再将字典一个一个输入即可。

import collections

dic = collections.OrderedDict()

 按照字典中的格式解析,解析之后将解析的数据再放入字典中,再根据索引读取数据即可,这里我们获取末端工具相对于基座坐标系的位姿。

data = s.recv(1500)
names=[]
ii=range(len(dic))
for key,i in zip(dic,ii):
    fmtsize=struct.calcsize(dic[key])
    data1,data=data[0:fmtsize],data[fmtsize:]
    fmt="!"+dic[key]
    names.append(struct.unpack(fmt, data1))
    dic[key]=dic[key],struct.unpack(fmt, data1)

a=dic["Tool vector actual"]
a2=np.array(a[1])
print(a2)
[ 0.35556756 -0.53704818  0.74460635  1.45930005  0.61347262  0.63800616]
x(m),y(m),z(m),rx(rad),ry(rad),rz(rad),

三、Socket控制85夹爪 

之前ROS实现不了的这次用socket实现。

夹爪控制主要是利用Github大佬提供的robotiq_gripper.py,该程序提供了一个RobotiqGripper类可以实现夹爪的激活,校准,开合这些功能供我们使用。可能是由于环境的不同,我直接用该代码会出现很多报错,并且校准功能无法实现。根据报错发现是OrderedDict()类有问题,具体什么问题也不知道,我换成了Dict类之后就解决了,直接贴出修改后的程序吧。代码的注释十分详细。

#!/usr/bin/env python3
import socket
import threading
import time
from enum import Enum
from typing import Union, Tuple, Dict

class RobotiqGripper:
    """
    Communicates with the gripper directly, via socket with string commands, leveraging string names for variables.
    """
    # WRITE VARIABLES (CAN ALSO READ)
    ACT = 'ACT'  # act : activate (1 while activated, can be reset to clear fault status)
    GTO = 'GTO'  # gto : go to (will perform go to with the actions set in pos, for, spe)
    ATR = 'ATR'  # atr : auto-release (emergency slow move)
    ADR = 'ADR'  # adr : auto-release direction (open(1) or close(0) during auto-release)
    FOR = 'FOR'  # for : force (0-255)
    SPE = 'SPE'  # spe : speed (0-255)
    POS = 'POS'  # pos : position (0-255), 0 = open
    # READ VARIABLES
    STA = 'STA'  
UR机器人与电脑进行socket通讯(python / C++) socket介绍 在计算机通信领域,socket 被翻译为“套接字”,它是计算机之间进行通信的一种约定或一种方式。通过 socket 这种约定,一台计算机可以接收其他计算机的数据,也可以向其他计算机发送数据   socket起源于Unix,而Unix/Linux基本哲学之一就是“一切皆文件”,都可以用“打开open –> 读写write/read –> 关闭close... 阅读详情

相关推荐

通过PC驱动真实UR10e机械臂(ROS)

记录一下通过ROS+Moveit控制机械臂运动的过程对于85夹爪目前查到的博客都说很难通过ROS直接驱动连接在UR工控箱内的夹爪,现有的ROS控制多是将夹爪数据线直接接到PC上通过USB串口进行通信。然而实验室的夹爪根本没有USB线(╯‵□′)╯︵┻━┻。

Forbiven的博客 5277

在ros里给机械臂加上夹爪和底盘后,控制真实机械臂

使用ur3_bringup 可以连接真实机械臂 使用官方的ur3_moveit_planning_execution.launch 可以对机械臂 moveit规划。 但是只有机械臂,没有夹爪。 官方如图: 我把原来的ur3_moveit_config 复制出来,修改 然后把ur3.xacro 等模型文件复制出来修改,修改完之后,有了夹爪,有了底盘。 规划组什么的使用moveit setup assistant 配置过了。 在rviz中可以笛卡尔空间规划了。 ...

超级菜 2721

gazebo、rviz、ros真实控制机械案例

ROS学习笔记07、机器人系统仿真(URDF、Xacro、Arbotix、Gazebo)机器人学习必看系列:如何使用moveit控制真实机械臂?控制真实机械臂(3)——控制真实机械臂(4)——控制真实机械臂(5)——

pvmsmfchcs的博客 271

Windows Sockets 编程及UR机器人通信数据解析代码

用于UR机器人的通信及通信数据解析,内容包括完整的Windows Sockets编程,以及UR机器人的通信协议解析、字节顺序变换等。

Android Studio运行报错: failed to load include path ……\platforms\android-35\android.jar的最细解决方案

【代码】Android Studio运行报错: failed to load include path ……\platforms\android-35\android.jar的最细解决方案。

2401_86789230的博客 2万+

西门子RS485自由口通信Modbus RTU 通信协议

部分西门子的RS485模块不能使用西门子自带的Modbus RTU通信指令,需要通过自己拼接、发送、接收和解析报文完成Modbus RTU通信。通过多次尝试完成该功能: #R_TRIG_Instance(CLK := #触发, Q => #触发上升沿); IF #触发上升沿 THEN // 触发后先将读取完成复位 #读写完成 := 0; END_IF; CASE #功能码 OF 1: // 线圈状态读取 ; 2:

qq_20792765的博客 1万+

基于FPGA的TDC延迟链优化与码密度校准方法(1)——原理与实现

本文深入探讨了基于FPGA的时间数字转换器(TDC)延迟链非均匀性问题及其码密度校准方法。通过分析工艺偏差、温度电压影响等根源,详细介绍了码密度测试原理、逐位校准技术及气泡消除算法,并分享了自适应校准策略与多场景应用实践,有效提升TDC测量精度至皮秒级。

kiwi8的博客 490

纳米尺度仿真软件:GROMACS_(3).分子动力学模拟原理

分子动力学(MD)模拟是一种强大的计算方法,通过数值积分牛顿运动方程,追踪粒子在时间上的位置和速度变化,提供关于体系动力学行为的详细信息。选择合适的力场、设置初始条件、应用边界条件、控制温度和压力、选择合适的时间步长、计算能量和力,是 MD 模拟的关键步骤。通过这些步骤,可以对各种化学、生物和材料体系进行模拟和分析,揭示其结构、动力学和热力学性质。高级应用如反应路径模拟和蛋白质折叠研究,进一步扩展了 MD 模拟的应用范围。

kkchenjj的博客 1103

锂电池SOC估计 | 基于LSTM长短期记忆神经网络的锂电池SOC估计(附matlab完整代码)

锂电池SOC估计 | 基于LSTM长短期记忆神经网络的锂电池SOC估计(附matlab完整代码)

前程算法屋的博客 1025

肖特基二极管的反向恢复过程

本博客简述肖特基二极管反向恢复过程。

记得诚 1万+

【第三方互联】3、腾讯QQ授权第三方登录

当我们创建的 QQ 互联应用成功后,我们便可以开始使用该应用来实现 QQ 互联 一、获取 APP ID 和 APP Key 1、找到我的应用 2、点击应用,进入详情 这样,我们就获取到了 APP ID 和 APP Key 二、进行开发 1、将 APP ID 、APP Key,以及该应用的信息放入项目中的配置文件中,我使用的是SpringBoot,我放在了 application.y...

JACKAL 22万+

分类预测 | MATLAB实现ELM极限学习机多特征分类预测(二分类)

分类预测 | MATLAB实现ELM极限学习机多特征分类预测(二分类)

机器学习之心的博客,关注并私信文章链接,获取对应文章源码和数据。 781

锂电池充电器电路设计 里面有电路

锂电池充电器电路设计 里面有电路 3.7V升压到5V电路设计。

C# WinForm 基于DirectShow.dll编写的程序,可边预览边保存视频,音频和图片

基于微软的DirectShow.dll的二次开发1.自动识别连接的摄像头跟麦克风且可以对其进行选择(默认选中第一个)2.可录制wmv和avi两种格式的视频并且都带有音频,avi可以录制的分辨率和帧数进行选择,wmv默认进行了淸晰度优化如不喜欢可去除代码中有相关提示3.可在预览点开之后进行拍照,也可边录制视频边拍照4.添加了视频和音频的压缩功能(酌情使用)这次二次开发发现C#对DirectShow的相关信息太少,这次做完也不敢藏私共享出来,还望大家指正

贝叶斯统计 [韦来生编]

贝叶斯(Bayes)统计是近几十年来迅速发展起来的数理统计的一个重要分支。贝叶斯方法与经典统计方法的主要不同之处是进行统计推断时除了利用样本信息外,还要利用参数的先验信息,因此可以提高统计推断或统计决策的效果。它在经济、金融、生物、医学、自然科学和社会科学等许多领域具有广泛的应用。贝叶斯方法的研究已渗透到了统计学的几乎所有领域。作者在给中国科学技术大学概率论与数理统计专业本科生开设的“数理统计”课程中有一章专门讲授“贝叶斯方法和统计决策理论”,近十年来也给中国科学技术大学概率统计专业研究生开设过几次“贝叶斯分析”课。本书是在对过去讲稿的内容作了适当的增减和调整的基础上完成的。  本书共分六章。第1章是绪论,介绍了贝叶斯统计的若干基本概念,同时对必要的数理统计的基础知识有重点地作了回顾。第二章介绍了确定先验分布的若干可供选择的方法。第三章介绍了几类常见统计模型参数的后验分布的主要结果和计算方法。第四章和第五章分别介绍了“贝叶斯统计推断”和“贝叶斯统计决策”的内容。第六章介绍了贝叶斯统计计算的若干方法,包括蒙特卡洛方法和马尔可夫链蒙特卡洛(MCMC)方法以及相关统计软件的简介。本书的每一章附右大量的例题和习题,书末附有常用的几个表格和部分习题解答供读者查用。  大约可在54学时内讲授本书的第1章至第六章的主要内容,教师可根据学时需要选讲本书第1章至第六章的部分内容。书中标“*”号的章节可略去不讲,留给读者作为阅读材料。第六章例题中的R代码和部分例题的数据文件等可从作者个人主页下载。  作者在编写本书的过程中参考了J.O.Berger教授的《统计决策论及贝叶斯分析》和茆诗松教授编写的《贝叶斯统计》等书中的一些内容,以及《贝叶斯分析》一书中由张伟平博士编写的有关贝叶斯统计计算的一些内容。在此表示衷心感谢。  本书编写准备过程中,中国科学技术大学统计与金融系的几个研究生帮助完成了本书部分中文的录入和排版,作者对他们的辛勤工作表示真诚的感谢。高等教育出版社为本书的出版给予了大力支持。在此一并致谢。

汉书HE8,好用的汇编代码编写工具

汉书HE8,好用的汇编代码编写工具早期编写汇编代码所用功能强大

上一篇: 通过PC驱动真实UR10e机械臂(ROS)
下一篇: UR10e+d405相机 easy_handeye眼在手上标定过程记录
S1aoXuan_
博客等级 码龄10年 114粉丝 12原创
评论 10
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付:10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值