### 控制 TurtleSim 并打印位置和姿态 要在 Linux 系统中使用 Python 编写程序来控制 ROS 中的 TurtleSim 移动，并打印其当前位置和姿态，可以按照以下方法实现。 #### 1. 创建 ROS 节点 首先需要创建一个 ROS 节点，该节点订阅 `turtle1/pose` 主题以获取当前的位置和姿态数据，并发布到 `/turtle1/cmd_vel` 主题以控制乌龟移动。可以通过 Python 的 rospy 库完成此操作[^2]。 以下是完整的代码示例： ```python #!/usr/bin/env python import rospy from geometry_msgs.msg import Twist from turtlesim.msg import Pose class TurtleController: def __init__(self): # 初始化节点 rospy.init_node('turtle_controller', anonymous=True) # 订阅Pose主题 self.pose_subscriber = rospy.Subscriber('/turtle1/pose', Pose, self.update_pose) # 发布Twist消息至cmd_vel主题 self.velocity_publisher = rospy.Publisher('/turtle1/cmd_vel', Twist, queue_size=10) self.current_pose = Pose() def update_pose(self, data): """更新当前的姿态""" self.current_pose = data self.current_pose.x = round(self.current_pose.x, 4) self.current_pose.y = round(self.current_pose.y, 4) def move_turtle(self, linear_speed, angular_speed): """控制乌龟移动""" vel_msg = Twist() vel_msg.linear.x = linear_speed vel_msg.angular.z = angular_speed rate = rospy.Rate(10) # 设置频率为10Hz while not rospy.is_shutdown(): # 打印当前姿态 rospy.loginfo(f"Turtle Position -> x: {self.current_pose.x}, y: {self.current_pose.y}") # 发布速度指令 self.velocity_publisher.publish(vel_msg) rate.sleep() if __name__ == '__main__': try: controller = TurtleController() controller.move_turtle(linear_speed=1.0, angular_speed=0.5) # 设置线性和角速度 except rospy.ROSInterruptException: pass ``` 上述代码定义了一个名为 `TurtleController` 的类，它初始化了 ROS 节点并设置了两个主要功能：订阅 `Pose` 数据以及发布 `Twist` 命令给乌龟模拟器[^3]。 #### 2. 配置 launch 文件 为了更方便地启动多个节点（例如同时启动控制器和服务），可以在 `.launch` 文件中配置这些参数。下面是一个简单的 launch 文件例子： ```xml <launch> <!-- 启动turtlesim_node --> <node pkg="turtlesim" type="turtlesim_node" name="sim"/> <!-- 启动自定义的controller节点 --> <node pkg="your_package_name" type="turtle_control.py" name="controller" output="screen"/> </launch> ``` 这里假设您已经将上面提到的 Python 脚本保存为 `turtle_control.py` 并放置在您的 ROS 包路径下。 #### 3. 运行环境准备 确保已安装必要的依赖项，包括但不限于 `rospy`, `geometry_msgs`, 和 `turtlesim`. 另外还需确认 Python 脚本具有可执行权限: ```bash chmod +x ~/catkin_ws/src/your_package/scripts/turtle_control.py ``` 最后，在终端输入如下命令运行整个系统: ```bash roslaunch your_package_name turtle.launch ``` 这样就可以看到乌龟按设定的速度前进的同时不断输出它的实时坐标信息。 ---