ROS小车——雷达的使用与SLAM建图(4)


前言

启动激光雷达并查看数据,建图并避障导航


一、激光雷达

1.启动激光雷达

roslaunch robot_navigation lidar.launch在终端输入启动雷达,雷达开始旋转,
并打印scan话题,rostopic echo/scan,在虚拟机中 roslaunch robot_navigation lidar_rviz.launch 查看图形化的雷达数据。

捕获

二、运行激光SLAM

1.打开slam

roslaunch robot_navigation robot_slam_lidar.launch在终端输入启动slam,
虚拟机输入roslaunch robot_navigation slam_rviz.launch
捕获2

2.机器人运动建图

新终端运行遥控节点rosrun teleop_twist_keyboard teleop_twist_keyboard.py
红色为边界,移动中不能发生碰撞,在实验室的建图如图所示。
捕获3
保存地图的位置是robot_anvigation目录下的一个map文件,跳转过去roscd robot_navigation/maps/,rosrun map_server map_saver map_saver -f map,地图名字为map

3.机器人导航避障

先启动机器人导航应用,roslaunch robot_navigation robot_navigation.launch,
此处启动上面的map地图,打开虚拟机使用已经配置的rviz文件,roslaunch robot_navigation navigation_rviz.launch
捕获
此时还没有定位,是有偏差的。用2D Pose Estimate来重新标定一个起始点。然后2D Nav Goal规划路径。

在这里插入图片描述


  • 4
    点赞
  • 40
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
【资源说明】 1、该资源包括项目的全部源码,下载可以直接使用! 2、本项目适合作为计算机、数学、电子信息等专业的课程设计、期末大作业和毕设项目,作为参考资料学习借鉴。 3、本资源作为“参考资料”如果需要实现其他功能,需要能看懂代码,并且热爱钻研,自行调试。 基于ROS的激光雷达+小车+IMU的SLAM建图、定位、路径规划c++实现源码+项目说明.zip # 单线激光雷达SLAM建图与路径规划 使用的硬件:autolabor pro1小车、小觅双目相机(S1030标准版本)、IntelNUC迷你主机、显示器、2D激光雷达 Delta-1A 使用的软件:ubuntu 16.04 LTS、ROS-kinetic、小觅驱动、autolabor pro1小车驱动、Delta-1A驱动、VINS-Fusion算法、ROS-navigation导航包、gmapping建图算法、cartographer_ros建图算法 ## tf介绍 tf变换:map(地图坐标系)-->odom(里程计坐标系)——>base_link(小车基座坐标系)——>传感器坐标系(lidar、camera) ---- map-->odom 由建图算法提供 ---- odom --> base_link 由小车驱动提供 ---- base_link --> 传感器坐标系 根据传感器在小车上安装的位置确定,使用static_transform_publisher静态坐标转换来设置 所需传感器数据类型: sensor_msgs/LaserScan 使用Delta-1A驱动发布的雷达扫描话题,话题名:/scan 所需里程计信息数据类型:nav_msgs/Odometry 使用autolabor pro1发布的里程计,话题名:/wheel_odom ## 建图 采用gmapping与 cartographer_ros建图算法分别进行建图 ### gmapping建图:(雷达+小车) 打开终端,执行如下指令: $ cd ~/catkin_ws_lidar_slam/ $ source devel/setup.bash $ roslaunch autolabor_box_launch create_map_gmapping.launch ####打开小车urdf模型、驱动、键盘控制节点、打开雷达驱动、打开gmapping节点、打开rviz可视化节点 ####此时使用键盘的上下左右键控制小车移动,开始建图 ####建图完成后,开启新的终端执行如下指令,保存地图: $ rosrun map_server map_saver -f map_name ####保存地图 map_name为保存地图的名称,运行结果,会生成2个文件,后缀名分别为 .pgm .yaml ### cartographer_ros建图:(雷达+小车) ##打开终端,执行如下指令: $ cd ~/catkin_ws_lidar_slam/ $ source devel/setup.bash $ roslaunch autolabor_box_launch create_map_cartographer.launch ####此时使用键盘的上下左右键控制小车移动,开始建图 ####建图完成后,开启新的终端执行如下指令,保存地图: $ rosrun map_server map_saver -f map_name ......
以下是一个简单的 ROS 小车基于激光雷达 SLAM 建图单点导航功能的实现代码: ```python #!/usr/bin/env python import rospy from geometry_msgs.msg import Twist from sensor_msgs.msg import LaserScan from nav_msgs.msg import Odometry from tf.transformations import euler_from_quaternion # 回调函数,用于获取小车当前位置 def get_odom(msg): global x, y, yaw x = msg.pose.pose.position.x y = msg.pose.pose.position.y orientation = msg.pose.pose.orientation (roll, pitch, yaw) = euler_from_quaternion([orientation.x, orientation.y, orientation.z, orientation.w]) # 回调函数,用于获取激光雷达数据 def get_scan(msg): global laser_data laser_data = msg.ranges # 判断小车是否到达目标点 def reached_goal(goal_x, goal_y, distance_tolerance): global x, y distance = abs(((goal_x - x)**2 + (goal_y - y)**2)**0.5) if distance < distance_tolerance: return True else: return False # 主函数 def main(): rospy.init_node('nav_test', anonymous=True) velocity_publisher = rospy.Publisher('/cmd_vel', Twist, queue_size=10) laser_subscriber = rospy.Subscriber('/scan', LaserScan, get_scan) odom_subscriber = rospy.Subscriber('/odom', Odometry, get_odom) # 等待获取激光雷达数据小车当前位置 while not rospy.is_shutdown(): try: laser_data[0] x y break except: continue goal_x = input("Enter goal x: ") goal_y = input("Enter goal y: ") distance_tolerance = input("Enter tolerance: ") # 控制小车前进或转向 vel_msg = Twist() while not rospy.is_shutdown(): if reached_goal(goal_x, goal_y, distance_tolerance): vel_msg.linear.x = 0 vel_msg.angular.z = 0 velocity_publisher.publish(vel_msg) rospy.loginfo("Goal reached!") break else: # 根据激光雷达数据,确定小车前进方向 front_middle_distance = laser_data[len(laser_data)/2] if front_middle_distance > 0.5: vel_msg.linear.x = 0.2 vel_msg.angular.z = 0 else: right_distance = laser_data[len(laser_data)*3/4] left_distance = laser_data[len(laser_data)/4] if right_distance > left_distance: vel_msg.linear.x = 0 vel_msg.angular.z = -0.5 else: vel_msg.linear.x = 0 vel_msg.angular.z = 0.5 velocity_publisher.publish(vel_msg) rospy.spin() if __name__ == '__main__': try: main() except rospy.ROSInterruptException: pass ``` 该代码首先初始化 ROS 节点,并订阅了激光雷达数据小车当前位置。然后,通过回调函数获取了激光雷达数据小车当前位置,并等待获取到这些信息之后再开始执行主循环。 在主循环中,通过输入目标点的坐标和容许的距离误差,控制小车前进或转向,直到到达目标点位置。在控制小车前进或转向时,先通过激光雷达数据确定小车前进方向,然后根据前进方向和目标点的位置计算出小车应该前进的速度和转向的角速度,并通过 /cmd_vel 话题发布给小车的底盘控制器。 值得注意的是,该代码中的小车前进方向的判断方法并不完备,只是一个简单的示例。如果需要更加精确的导航功能,需要使用更为复杂的算法和模型。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值