### 使用 Python 控制基于 `ros_arduino_bridge` 构建的小型移动机器人 #### 1. 环境搭建与准备工作 在开始编写控制脚本之前，需要确保已经成功安装并配置好了 `ros_arduino_bridge` 功能包。这包括上传固件到 Arduino 板以及启动 ROS 节点[^4]。 - **启动核心节点** 在终端中运行以下命令以激活 `ros_arduino_bridge`： ```bash roslaunch ros_arduino_python arduino.launch port:=<your_port> ``` 将 `<your_port>` 替换为实际的串口号（例如 `/dev/ttyACM0`）。 --- #### 2. 发布速度指令 小型移动机器人的运动通常是通过发布 Twist 类型的消息来实现的。可以利用 Python 编写一个简单的控制器程序向 `/cmd_vel` 主题发送线性和角速度值。 ##### 示例代码：Python 控制器 ```python #!/usr/bin/env python import rospy from geometry_msgs.msg import Twist def move_robot(): # 初始化节点 rospy.init_node('robot_controller', anonymous=True) # 创建 Publisher 对象 pub = rospy.Publisher('/cmd_vel', Twist, queue_size=10) # 设置循环频率 rate = rospy.Rate(10) # 10 Hz # 创建 Twist 消息对象 velocity_msg = Twist() while not rospy.is_shutdown(): # 设置前进的速度和方向 velocity_msg.linear.x = 0.2 # 前进速度 (m/s) velocity_msg.angular.z = 0.0 # 不旋转 # 发布消息 pub.publish(velocity_msg) # 输出日志信息 rospy.loginfo(f"Publishing linear_x={velocity_msg.linear.x}, angular_z={velocity_msg.angular.z}") # 控制循环速率 rate.sleep() if __name__ == '__main__': try: move_robot() except rospy.ROSInterruptException: pass ``` 上述代码会持续向前推进机器人直到手动停止进程为止[^5]。 --- #### 3. 键盘控制示例 除了硬编码固定动作外，还可以借助外部工具如 `teleop_twist_keyboard` 实现更加直观的人机交互体验。 - **启动键盘控制节点** 执行下面这条语句开启远程操控界面： ```bash rosrun teleop_twist_keyboard teleop_twist_keyboard.py ``` 此时按下箭头按键即可实时改变车辆行驶轨迹[^1]。 --- #### 4. 数据可视化 为了更好地观察系统状态变化情况，推荐配合 RViz 工具一起使用。只需简单几步就能让抽象化的数值变得形象化起来。 - **加载默认配置文件** 输入如下命令打开图形化窗口： ```bash rviz ``` 接着添加相应插件订阅感兴趣的话题流比如激光雷达扫描结果或者里程计估计位置等[^1]。 --- #### 5. 结合超声波传感器避障功能开发 假设已经在硬件层面集成了若干枚 HC-SR04 测距探头，则可通过读取它们返回的距离参数判断前方是否存在障碍物进而决定是否采取规避措施。 ##### 示范片段：检测最近物体距离 ```python import rospy from sensor_msgs.msg import Range MIN_DISTANCE_THRESHOLD = 0.3 # 米 def sonar_callback(data): global MIN_DISTANCE_THRESHOLD if data.range < MIN_DISTANCE_THRESHOLD: rospy.logwarn("Obstacle detected within threshold distance!") stop_robot() def init_subscriber(): rospy.Subscriber("/scan", Range, sonar_callback) def stop_robot(): cmd_pub = rospy.Publisher('/cmd_vel', Twist, queue_size=10) twist = Twist() twist.linear.x = 0.0 twist.angular.z = 0.0 cmd_pub.publish(twist) rospy.init_node('obstacle_avoidance') init_subscriber() rospy.spin() ``` 这里监听名为 "/scan" 的主题获取来自各个方向上的测量值一旦发现小于设定阈值的目标就会立即触发刹车响应[^2]。 --- ###