在ROS2中使用Python实现通过键盘控制Turtlebot的移动和旋转功能，需要完成以下几个关键步骤： ### 1. 订阅键盘输入 可以通过监听标准输入（`stdin`）来捕获用户的键盘输入。通常会使用`keyboard`库或直接操作`sys.stdin`来获取按键事件。 ### 2. 发布速度指令 Turtlebot 的运动是通过发布 `/cmd_vel` 主题上的 `geometry_msgs/Twist` 消息来控制的。该消息包含线速度（`linear.x`）和角速度（`angular.z`）字段。例如： - 向前：设置 `linear.x = 0.5` - 向后：设置 `linear.x = -0.5` - 左转：设置 `angular.z = 1.0` - 右转：设置 `angular.z = -1.0` - 停止：设置 `linear.x = 0` 和 `angular.z = 0` ### 3. 安全机制 为了防止因长时间按住按键而导致速度激增，可以引入一个定时器或标志位来限制命令的更新频率。此外，还需要处理异常情况，如无效输入或中断信号。 ### 示例代码 以下是一个完整的 Python 脚本示例，用于通过键盘控制 Turtlebot 在 ROS2 中的前后左右移动及旋转： ```python import rclpy from rclpy.node import Node from geometry_msgs.msg import Twist import sys import select import termios import tty class KeyboardController(Node): def __init__(self): super().__init__('keyboard_controller') self.publisher_ = self.create_publisher(Twist, 'cmd_vel', 10) self.timer_period = 0.1 # seconds self.timer = self.create_timer(self.timer_period, self.timer_callback) self.settings = termios.tcgetattr(sys.stdin) self.linear_velocity = 0.0 self.angular_velocity = 0.0 def getKey(self): tty.setraw(sys.stdin.fileno()) rlist, _, _ = select.select([sys.stdin], [], [], 0.1) if rlist: key = sys.stdin.read(1) else: key = '' termios.tcsetattr(sys.stdin, termios.TCSADRAIN, self.settings) return key def timer_callback(self): key = self.getKey() twist = Twist() if key == 'w': self.linear_velocity = 0.5 self.angular_velocity = 0.0 elif key == 's': self.linear_velocity = -0.5 self.angular_velocity = 0.0 elif key == 'a': self.linear_velocity = 0.0 self.angular_velocity = 1.0 elif key == 'd': self.linear_velocity = 0.0 self.angular_velocity = -1.0 elif key == ' ': self.linear_velocity = 0.0 self.angular_velocity = 0.0 elif key == '\x03': # Ctrl+C to exit self.get_logger().info('Shutting down...') sys.exit(0) twist.linear.x = self.linear_velocity twist.angular.z = self.angular_velocity self.publisher_.publish(twist) def main(args=None): rclpy.init() keyboard_controller = KeyboardController() try: rclpy.spin(keyboard_controller) except KeyboardInterrupt: pass finally: keyboard_controller.destroy_node() rclpy.shutdown() if __name__ == '__main__': main() ``` ### 使用说明 1. 确保你已经安装了 ROS2，并且 Turtlebot 模拟器（如 Gazebo 或 Web 模拟器）正在运行。 2. 将上述脚本保存为 `keyboard_control.py`。 3. 在终端中运行脚本： ```bash python3 keyboard_control.py ``` 4. 控制方式： - `W`：向前 - `S`：向后 - `A`：左转 - `D`：右转 - 空格键：停止 - `Ctrl+C`：退出程序 ### 注意事项 - 如果你使用的是远程机器人而不是模拟器，请确保网络连接正常并且 `/cmd_vel` 主题可用。 - 你可以根据需求调整速度值（`linear_velocity` 和 `angular_velocity`）以适应不同的运动场景。 ---