从零实现机器人自主避障

1. 编译工具安装

bash 复制代码
sudo apt update
sudo apt install python3-catkin-pkg python3-rosdep python3-rosinstall-generator python3-wstool python3-rosinstall build-essential
sudo rosdep init
rosdep update

2. 构建节点

bash 复制代码
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws
ros2 pkg create turtlebot_suo --build-type ament_python --dependencies rclpy sensor_msgs geometry_msgs

touch turtlebot_suo/turtlebot_suo/ob_avoid.py
chmod +x turtlebot_suo/turtlebot_suo/ob_avoid.py
# setup.py中定义ros2 run的入口
	entry_points={
	    'console_scripts': [
	        'ob_avoid = turtlebot_suo.ob_avoid:main',
	    ],
	},
cd ~/ros2_ws
colcon build --packages-select turtlebot_suo
source install/setup.bash

3. 避障程序

python 复制代码
#!/usr/bin/env python3
import rclpy
from rclpy.node import Node
from sensor_msgs.msg import LaserScan
from geometry_msgs.msg import Twist

class ObstacleAvoidance(Node):
    def __init__(self):
        super().__init__('ob_avoid')
        self.publisher_ = self.create_publisher(Twist, 'cmd_vel', 10)
        self.subscription_ = self.create_subscription(LaserScan,'scan',self.laser_scan_callback,10)
        self.subscription_  
    def laser_scan_callback(self, msg):
        # 获取前方90度范围内的最小距离
        front_range = msg.ranges[0:45] + msg.ranges[-45:]
        min_distance = min(front_range)
		# 避障逻辑
        cmd_msg = Twist()
        if min_distance < 0.5:
            # 障碍物距离小于0.5米时左转
            cmd_msg.angular.z = 0.5
            self.get_logger().info('# 障碍物距离小于0.5米,左转.')
        else:
            # 默认按固定速度直行
            cmd_msg.linear.x = 0.2
        self.publisher_.publish(cmd_msg)

def main(args=None):
    rclpy.init(args=args)
    node = ObstacleAvoidance()
    try:
        rclpy.spin(node)
    except KeyboardInterrupt:
        pass
    finally:
        node.destroy_node()
        rclpy.shutdown()

if __name__ == '__main__':
    main()

4. 效果

bash 复制代码
# 启动Gazebo仿真
roslaunch turtlebot3_gazebo turtlebot3_world.launch
# 启动避障节点(新终端)
ros2 run turtlebot_suo ob_avoid
相关推荐
民乐团扒谱机10 小时前
Rakazo 智能清洁机器人深度评测报告
机器人
feasibility.10 小时前
英伟达把物理AI的3D模型“应用商店”开放了:2575个SimReady仿真资产,总计约472GB,可让agent装配机器人训练场景
人工智能·3d·机器人·仿真·建模·具身智能·英伟达
wangxiaoxuan21714 小时前
机器人软件如何分层:驱动、算法、能力、动作与业务
机器人·科沃斯八界
kyle~16 小时前
模型预测控制(MPC)
算法·机器人·控制·传感器
飞Link17 小时前
灵巧手是什么?从机械结构、驱动方式到控制原理,认识机器人的精细操作能力
人工智能·python·机器人
mechanical_expert18 小时前
以SILVERTHIN SC047CP0为例计算等截面薄壁轴承摩擦损耗和启动扭矩
人工智能·机器人
wangxiaoxuan2171 天前
移动操作机器人如何协同:底盘、升降、机械臂与资源约束
机器人·科沃斯八界
天树星智源2 天前
记忆该记「赔率跳变」:机器人长时程十连任务,事件记忆 88.0%,删掉失败记录只剩 1.7%
论文阅读·人工智能·机器人
kyle~2 天前
因子图优化(Factor Graph Optimization)
c++·算法·机器人·传感器
硅谷秋水2 天前
MorphMimic 方法分析
人工智能·机器学习·计算机视觉·机器人