Python实战：5分钟搞定睿尔曼机械臂与AGV底盘的Socket通信（附完整代码）

Python实战5分钟搞定睿尔曼机械臂与AGV底盘的Socket通信附完整代码在工业自动化领域复合机器人正逐渐成为提升生产效率的关键设备。这类机器人通常由AGV自动导引运输车底盘和机械臂组成能够实现自主移动和精确操作的双重功能。本文将带你快速实现睿尔曼机械臂与AGV底盘之间的TCP/IP通信通过具体代码示例展示Socket连接建立、JSON指令发送和状态反馈接收全流程。1. 复合机器人通信基础复合机器人的核心在于各组件间的协同工作。睿尔曼机械臂与AGV底盘通常采用TCP/IP协议进行通信这种方案具有以下优势实时性TCP协议能确保指令的可靠传输灵活性支持跨平台、跨语言通信扩展性便于集成更多传感器或执行器通信架构通常采用客户端-服务器模式AGV底盘作为服务端监听特定端口机械臂作为服务端监听另一端口主控程序如NX控制器作为客户端分别连接两者# 典型通信架构示意图 ------------------- ------------------- ------------------- | AGV底盘服务端 | --- | 主控客户端程序 | --- | 机械臂服务端 | | (192.168.10.10) | | (192.168.10.11) | | (192.168.1.18) | ------------------- ------------------- -------------------2. 环境准备与依赖安装开始编码前确保你的开发环境已准备就绪Python版本推荐Python 3.8必要库pip install socket json time网络配置确保主控设备与AGV底盘、机械臂在同一局域网确认各设备的IP地址和端口号提示实际部署时建议使用静态IP或DHCP保留地址避免IP变动导致通信中断。3. 实现AGV底盘通信AGV底盘通常提供RESTful风格的API接口通过发送特定格式的字符串指令实现控制。以下是完整实现代码import socket import json import time class AGVController: def __init__(self, host192.168.10.10, port31001): self.host host self.port port self.socket socket.socket(socket.AF_INET, socket.SOCK_STREAM) def connect(self): 建立与AGV底盘的连接 try: self.socket.connect((self.host, self.port)) print(f成功连接到AGV底盘 {self.host}:{self.port}) return True except Exception as e: print(f连接AGV失败: {str(e)}) return False def send_command(self, command): 发送指令并接收响应 try: self.socket.send(command.encode(utf-8)) response self.socket.recv(1024).decode() return response except Exception as e: print(f指令发送失败: {str(e)}) return None def get_map_list(self): 获取地图列表 return self.send_command(/api/map/list) def move_to_marker(self, marker_name): 移动至指定标记点 return self.send_command(f/api/move?marker{marker_name}) def get_robot_status(self): 获取机器人状态 return self.send_command(/api/robot_status) def close(self): 关闭连接 self.socket.close() print(AGV连接已关闭) # 使用示例 if __name__ __main__: agv AGVController() if agv.connect(): print(地图列表:, agv.get_map_list()) print(移动到071901:, agv.move_to_marker(071901)) time.sleep(2) # 等待移动完成 print(当前状态:, agv.get_robot_status()) agv.close()关键参数说明参数类型说明hoststrAGV底盘IP地址portintAGV控制端口通常31001/api/map/liststr获取可用地图列表/api/move?markerxxxstr移动至指定标记点/api/robot_statusstr获取底盘状态信息4. 机械臂控制实现睿尔曼机械臂采用JSON格式的指令协议支持关节运动(MoveJ)和直线运动(MoveL)等操作。以下是完整控制代码import socket import json import time class RoboticArmController: def __init__(self, host192.168.1.18, port8080): self.host host self.port port self.socket socket.socket(socket.AF_INET, socket.SOCK_STREAM) def connect(self): 建立与机械臂的连接 try: self.socket.connect((self.host, self.port)) print(f成功连接到机械臂 {self.host}:{self.port}) return True except Exception as e: print(f连接机械臂失败: {str(e)}) return False def send_json_command(self, command_dict): 发送JSON格式指令 try: command_str json.dumps(command_dict) \r\n self.socket.send(command_str.encode(utf-8)) response self.socket.recv(1024).decode() return json.loads(response) if response else None except Exception as e: print(f指令发送失败: {str(e)}) return None def get_arm_state(self): 查询机械臂状态 return self.send_json_command({command: get_current_arm_state}) def move_joint(self, joints, speed50, blend_radius0): 关节空间运动 command { command: movej, joint: joints, v: speed, r: blend_radius } return self.send_json_command(command) def move_linear(self, pose, speed50, blend_radius0): 笛卡尔空间直线运动 command { command: movel, pose: pose, v: speed, r: blend_radius } return self.send_json_command(command) def close(self): 关闭连接 self.socket.close() print(机械臂连接已关闭) # 使用示例 if __name__ __main__: arm RoboticArmController() if arm.connect(): # 获取当前状态 print(机械臂状态:, arm.get_arm_state()) # 关节空间运动示例 joint_target [100, 200, 300, 400, 500, 600] # 各关节角度(0.1°单位) print(关节运动:, arm.move_joint(joint_target, speed30)) time.sleep(3) # 等待运动完成 # 直线运动示例 cartesian_target [100000, 200000, 30000, 400, 500, 600] # [x,y,z,rx,ry,rz] print(直线运动:, arm.move_linear(cartesian_target, speed10)) arm.close()机械臂指令参数详解{ command: movej, # 指令类型movej(关节运动)/movel(直线运动) joint: [100,200,300,400,500,600], # 目标关节角度(0.1°为单位) pose: [100000,200000,30000,400,500,600], # 目标位姿[x(mm),y,z,rx(0.001rad),ry,rz] v: 50, # 速度百分比(0-100) r: 0 # 交融半径(mm)0表示精确到达 }5. 完整系统集成与实战技巧将AGV底盘和机械臂控制整合到一个系统中可以实现更复杂的自动化任务。以下是集成示例和实用技巧class CompositeRobot: def __init__(self, agv_host192.168.10.10, arm_host192.168.1.18): self.agv AGVController(agv_host) self.arm RoboticArmController(arm_host) def pick_and_place(self, marker_name, joint_pos, cartesian_pos): 移动至目标点并执行抓取放置操作 try: # 连接设备 if not self.agv.connect() or not self.arm.connect(): return False # 移动AGV至目标位置 print(AGV移动中...) agv_response self.agv.move_to_marker(marker_name) print(AGV响应:, agv_response) # 等待AGV到位 time.sleep(3) # 机械臂操作序列 print(机械臂开始操作...) self.arm.move_joint(joint_pos) # 移动到准备位置 time.sleep(2) self.arm.move_linear(cartesian_pos) # 精确移动到目标位置 time.sleep(1) # 此处可添加夹爪控制代码 time.sleep(0.5) self.arm.move_joint(joint_pos) # 返回准备位置 return True except Exception as e: print(f操作失败: {str(e)}) return False finally: self.agv.close() self.arm.close() # 实战技巧 1. 异常处理为每个关键操作添加try-catch块 2. 状态验证在执行移动前检查设备状态 3. 超时机制为关键操作设置超时限制 4. 日志记录记录所有指令和响应便于调试 5. 速度优化根据任务需求调整运动速度 常见问题解决方案问题现象可能原因解决方案连接超时IP地址错误/网络不通检查网络连接和IP配置指令无响应端口错误/服务未启动确认目标端口和服务状态机械臂运动异常关节超限/奇异位置检查目标位置是否可达AGV移动失败标记点不存在确认地图和标记点名称通信中断网络波动/线缆问题检查物理连接添加重试机制6. 性能优化与安全注意事项在实际部署中还需要考虑以下关键因素通信性能优化使用多线程处理不同设备的通信实现心跳机制保持长连接压缩JSON数据减少传输量本地缓存常用指令响应安全防护措施# 安全校验示例 def safe_move_agv(marker_name, max_retry3): for attempt in range(max_retry): try: response agv.move_to_marker(marker_name) if error not in response.lower(): return True except Exception: time.sleep(1) # 等待后重试 raise Exception(fAGV移动失败重试{max_retry}次后仍不成功) # 运动范围限制 def validate_joint_angles(angles, limits[(-1700,1700),(-900,900),...]): for angle, (min_val, max_val) in zip(angles, limits): if not min_val angle max_val: raise ValueError(f关节角度{angle}超出限制范围({min_val},{max_val}))最佳实践建议为每个关键操作添加状态检查和异常处理实现运动指令的队列管理避免冲突在机械臂运动前进行碰撞检测设置合理的超时和重试机制保留足够的调试日志通过以上代码和技巧你可以快速构建稳定可靠的复合机器人控制系统。在实际项目中建议先从简单任务开始逐步增加复杂度同时建立完善的测试流程。