ROS2在MyCobot320Pi2022和PC之间通讯(都是Ubuntu20.04系统)

参考:

1. Running ROS across multiple machines http://wiki.ros.org/ROS/Tutorials/MultipleMachines
2. SLAM+语音机器人DIY系列：（五）树莓派3开发环境搭建——4.PC端与robot端ROS网络通信 https://www.cnblogs.com/hiram-zhang/p/10410168.html
3. 在多台PC上进行ROS通讯（在多台远程机器人或电脑上运行ROS）-学习笔记 https://blog.51cto.com/u_12369060/5172376
4. [基于ROS构建移动机器人]第二篇：设置ROS主从网络和远程开发环境 https://zhuanlan.zhihu.com/p/52005221/

示例代码:使用PC驱动Raspberry机械臂,并以10Hz的频率发布机械臂末端法兰盘相对于基座坐标系的坐标:

------ Notes ------
Aim to control and monitor robot arm (MyCobot320pi2022) through PC. Both with Ubuntu 20.04 and ROS 2 Galactic installed.
The command comes from the MECHREV computer (PC), whose hostname is `zsfmec`. IP: 192.168.117.142, passcode:zsf2603
The executor is Raspberry with hostname `er`. IP: 192.168.117.179, passcode: 123

------ Topic list defined in this packgae ------
1. /robot_arm/coordinates
2. 
3. 



------ Usage ------
1. Connect the two devices in the same WiFi: phone hotspot called: Redmi K40, passcode: zsf20220912
2. Raspberry: open the folder ~/Desktop/pymycobot/demo in terminal, and execute:
    `python3 Server.py`, press Enter
    open another terminal inside the folder ~/Desktop/pymycobot/demo, and execute:
    `python3 Server1.py`, press Enter
3. PC: 
    open a terminal and run /home/zsfmec/ros2_ws/src/robot_control/robot_control/coordinate_publisher.py
    open another terminal and run /home/zsfmec/ros2_ws/src/robot_control/robot_control/actuate_robot.py

------ 我的笔记 ------
PC与MyCobot通讯可以参考我的CSDN的文章: https://blog.csdn.net/weixin_42776565/article/details/137049334

/home/zsfmec/ros2_ws/src/robot_control/robot_control/coordinate_publisher.py

#!/usr/bin/env python3
import rclpy
from rclpy.node import Node
from std_msgs.msg import Float32MultiArray  # Replace String with appropriate message type for coordinates
from pymycobot import MyCobotSocket  # Import the MyCobotSocket library for TCP/IP connection
import time

class CoordinatePublisher(Node):
    def __init__(self):
        super().__init__('coordinate_publisher')
        self.publisher_ = self.create_publisher(Float32MultiArray, '/robot_arm/coordinates', 10)
        self.timer = self.create_timer(0.1, self.publish_coordinates)  # 0.1 seconds corresponds to 10Hz
        
        # Initialize MyCobotSocket connection to the robot arm
        self.tcp_ip = '192.168.117.179'  # Replace with the IP address of the robot arm
        self.tcp_port = 9000  # Default MyCobot port
        
        try:
            self.mc = MyCobotSocket(self.tcp_ip, self.tcp_port)
            self.get_logger().info('Connected to robot arm via TCP/IP')
        except Exception as e:
            self.get_logger().error(f'Failed to connect to robot arm: {e}')

    def publish_coordinates(self):
        try:
            # Request angles from the robot arm via TCP/IP
            coords = self.mc.get_coords()  # Get the end-effector coordinates
            if coords:
                msg = Float32MultiArray()  # Using Float32MultiArray to hold coordinate values
                msg.data = coords
                self.publisher_.publish(msg)
                self.get_logger().info(f'Publishing coordinates: {coords}')
        except Exception as e:
            self.get_logger().error(f'Failed to get coordinates: {e}')


def main(args=None):
    rclpy.init(args=args)
    node = CoordinatePublisher()
    rclpy.spin(node)
    node.destroy_node()
    rclpy.shutdown()

if __name__ == '__main__':
    main()

/home/zsfmec/ros2_ws/src/robot_control/robot_control/actuate_robot.py

from pymycobot import MyCobotSocket
import time
#其中"192.168.11.15"为机械臂IP，请自行输入你的机械臂IP
mc = MyCobotSocket("192.168.117.179",9001)  

#连接正常就可以对机械臂进行控制操作
mc.send_angles([0,0,0,0,0,0],20)
time.sleep(3)
mc.send_angles([30,20,0,0,0,0],20)
time.sleep(3)
mc.send_angles([0,0,0,0,0,0],20)
time.sleep(3)
mc.send_angles([-30,-20,0,0,0,0],20)
time.sleep(3)