基于机器人（irobot）和激光雷达（rplidar）gmapping地图构建

基于机器人（irobot）和激光雷达（rplidar）gmapping地图构建

说明

• 介绍irobot搭载激光雷达irplidar通过gmapping算法构建地图

安装准备

• 测试环境Ubuntu14.04 + indigo
• ROS依赖包：
  
  • Turtlebot机器包
    https://github.com/turtlebot/turtlebot
    https://github.com/ncnynl/turtlebot_apps.git
  • 激光雷达rplidar一代驱动包
    https://github.com/ncnynl/rplidar_ros.git
  • slam_gmapping
    https://github.com/ros-perception/slam_gmapping
  • openslam_gmapping包
    https://github.com/ros-perception/openslam_gmapping

步骤

• 创建工作空间

mkdir -p ~/catkin_ws/src
cd ~/catkin_ws/src

• 下载turtlebot相关包

git clone https://github.com/turtlebot/turtlebot
git clone https://github.com/ncnynl/turtlebot_apps.git

• 下载激光雷达rplidar一代驱动

git clone https://github.com/ncnynl/rplidar_ros.git

• 下载slam_gmapping

git clone https://github.com/ros-perception/slam_gmapping

• 下载openslam_gmapping

git clone https://github.com/ros-perception/openslam_gmapping

• 编译

cd ~/catkin_ws
catkin_make
source devel/setup.bash

参数设置

环境参数设置

export TURTLEBOT_BASE=roomba
export TURTLEBOT_STACKS=circles
export TURTLEBOT_3D_SENSOR=rplidar
export TURTLEBOT_SERIAL_PORT=/dev/ttyUSB0

激光雷达串口设置

• 创建激光雷达串口别名，确认idVendor和idProduct，ID后面的部分idVendor:idProduct

lsusb
Bus 001 Device 006: ID 10c4:ea60

• 新建 /etc/udev/rules.d/rplidar.rules文件，内容如下：(别名为rplidar，实际名称为：/dev/rplidar)

KERNEL==”ttyUSB*”, ATTRS{idVendor}==”10c4”, ATTRS{idProduct}==”ea60”,
MODE:=”0666”, GROUP:=”dialout”, SYMLINK+=”rplidar”

• 增加当前用户对串口的默认访问权限：

sudo usermod -a -G dialout 用户名

• 使UDEV配置生效：（使串口的默认访问权限生效，需要重启机器）

sudo service udev reload
sudo service udev restart

制作雷达启动文件

• 建立rplidar_laser.launch文件

roscd turtlebot_navigation
mkdir -p laser/driver
touch rplidar_laser.launch

• 完整代码为：

<launch>   <!--激光rplidar的启动文件，设置相关参数 -->   <node name="rplidarNode"          pkg="rplidar_ros"  type="rplidarNode" output="screen">   <param name="serial_port"         type="string" value="/dev/ttyUSB1"/>    <param name="serial_baudrate"     type="int"    value="115200"/>   <param name="frame_id"            type="string" value="laser"/>   <param name="inverted"            type="bool"   value="false"/>   <param name="angle_compensate"    type="bool"   value="true"/>   </node>   <node pkg="tf" type="static_transform_publisher" name="base_to_laser" args="0.0 0.0 0.18 0.0 0.0 0.0 base_link laser 100"/> </launch>

• 说明：

  • 检查serial_port是否正确，正确使用别名
  • 增加tf，修改args=”x y z qx qy qz frame_id child_id period_in_ms”，单位为m

• 增加rplidar_gmapping.launch.xml文件，设置gmapping参数

<launch>   <arg name="scan_topic"  default="scan" />   <arg name="base_frame"  default="base_footprint"/>   <arg name="odom_frame"  default="odom"/>   <node pkg="gmapping" type="slam_gmapping" name="slam_gmapping" output="screen" clear_params="true" >     <param name="base_frame" value="$(arg base_frame)"/>     <param name="odom_frame" value="$(arg odom_frame)"/>     <param name="map_update_interval" value="5"/> <!--地图更新的时间间隔。更新间隔越小，计算负荷越大，地图更新也受scanmatch的影响，如果scanmatch没有成功的话不会更新地图 default: 5.0-->     <param name="maxUrange" value="6.0"/> <!--探测最大可用范围，计光束能到的范围default80.0 -->     <param name="maxRange" value="6.0"/>     <param name="sigma" value="0.05"/> <!-- 用作结束点匹配-->     <param name="kernelSize" value="1"/>     <param name="lstep" value="0.05"/>     <param name="astep" value="0.05"/>     <param name="iterations" value="5"/>     <param name="lsigma" value="0.075"/>  <!--波束的sigma，用来计算似然估计每次扫描跳过的波束-->     <param name="ogain" value="3.0"/>  <!--用来平滑重采样的影响-->     <param name="lskip" value="0"/>  <!--每次扫描跳过的波束评估似然的增益，用来平滑重采样的影响-->     <param name="minimumScore" value="80"/>  <!--避免在大空间范围内使用有限距离的激光仪出现的jumping pose estimates问题，决定对激光的一个置信度，越高说明对激光匹配算法的要求越高，激光的匹配也越容易失败转而去使用里程计数据，太低又会使地图出现大量噪声，所以需要权衡条在-->     <param name="srr" value="0.01"/>  <!--平移时里程误差作为平移函数0.1-->     <param name="srt" value="0.02"/>  <!--平移时里程误差作为旋转函数0.2-->     <param name="str" value="0.01"/>   <!--旋转时里程误差作为平移函数0.1-->     <param name="stt" value="0.02"/>   <!--旋转时里程误差作为旋转函数0.1-->     <param name="linearUpdate" value="0.05"/>  <!--机器人每旋转这么远处理一次扫描1-->     <param name="angularUpdate" value="0.0436"/>     <param name="temporalUpdate" value="-1.0"/>  <!--如果最新扫描处理比更新慢，则处理1次扫描，该值为负数时关闭基于时间的更新-->     <param name="resampleThreshold" value="0.5"/>  <!--基于重采样门限的Neff-->     <param name="particles" value="200"/>   <!--滤波器中粒子个数30-->     <param name="xmin" value="-1.0"/>  <!--地图初始尺寸-100,-100,100,100-->     <param name="ymin" value="-1.0"/>     <param name="xmax" value="1.0"/>     <param name="ymax" value="1.0"/>     <param name="delta" value="0.05"/>  <!--地图分辨率-->     <param name="llsamplerange" value="0.01"/>     <param name="llsamplestep" value="0.01"/>     <param name="lasamplerange" value="0.005"/>     <param name="lasamplestep" value="0.005"/>     <remap from="scan" to="$(arg scan_topic)"/>   </node> </launch>

• 增加rplidar_gmapping_demo.launch文件，用于启动gmapping

roscd turtlebot_navigation
touch launch/irobot_rplidar_gmapping_demo.launch

• 代码为：

<launch>   <!--启动irobot机器人-->   <include file="$(find turtlebot_bringup)/launch/minimal.launch"/>  <!-- 启动rplidar雷达驱动 -->   <include file="$(find turtlebot_navigation)/laser/driver/rplidar_laser.launch" />   <!-- Gmapping-->   <include file="$(find turtlebot_navigation)/launch/rplidar_gmapping_params.launch.xml"/>   <!-- Move base-->   <include file="$(find turtlebot_navigation)/launch/move_base.launch"/>   <include file="$(find turtlebot_rviz_launchers)/launch/view_navigation.launch"/> </launch>

• 新建move_base.launch文件

roscd turtlebot_navigation
touch launch/move_base.launch

<launch>  <node pkg="move_base" type="move_base" respawn="false" name="move_base" output="screen" clear_params="true">    <param name="footprint_padding" value="0.01" />     <param name="controller_frequency" value="10.0" />     <param name="controller_patience" value="3.0" />     <param name="oscillation_timeout" value="30.0" />     <param name="oscillation_distance" value="0.5" />     <rosparam file="$(find turtlebot_navigation)/config/costmap_common_params.yaml" command="load" ns="global_costmap" />     <rosparam file="$(find turtlebot_navigation)/config/costmap_common_params.yaml" command="load" ns="local_costmap" />     <rosparam file="$(find turtlebot_navigation)/config/local_costmap_params.yaml" command="load" />     <rosparam file="$(find turtlebot_navigation)/config/global_costmap_params.yaml" command="load" />     <rosparam file="$(find turtlebot_navigation)/config/base_local_planner_params.yaml" command="load" />   </node> </launch>

• 增加move_base.launch文件中的.yaml文件

roscd turtlebot_navigation
mkdir -p config
touch config/costmap_common_params.yaml
touch config/lobal_costmap_params.yaml
touch config/global_costmap_params.yaml
touch config/base_local_planner_params.yaml

• 增加costmap_common_params.yaml文件

obstacle_range: 2.5 raytrace_range: 3.0 robot_radius: 0.17 inflation_radius: 0.18 max_obstacle_height: 0.6 min_obstacle_height: 0.0 observation_sources: laser_scan_sensor laser_scan_sensor: {sensor_frame: /base_laser_link, data_type: LaserScan, topic: /base_scan, marking: true, clearing: true}

• 增加local_costmap_params.yaml文件

  local_costmap:    global_frame: /odom    robot_base_frame: /base_link    update_frequency: 3.0    publish_frequency: 2.0    static_map: false    rolling_window: true    width: 4.0    height: 4.0    resolution: 0.05

• 增加 global_costmap_params.yaml文件

   global_costmap:    global_frame: /odom    robot_base_frame: /base_link    update_frequency: 3.0    publish_frequency: 0.0   #static_map: true

• 增加base_local_planner_params.yaml文件

controller_frequency: 5.0 TrajectoryPlannerROS:   max_vel_x: 0.20   min_vel_x: 0.10   max_rotational_vel: 0.4   min_in_place_rotational_vel: 0.1   acc_lim_th: 0.75   acc_lim_x: 0.50   acc_lim_y: 0.50   holonomic_robot: false   yaw_goal_tolerance: 0.05   xy_goal_tolerance: 0.1   goal_distance_bias: 0.8   path_distance_bias: 0.6   sim_time: 1.2   heading_lookahead: 0.325   oscillation_reset_dist: 0.05   vx_samples: 6   vtheta_samples: 20   dwa: false

测试激光雷达gmapping构建地图

• 打开roscore，启动turtlebot、gmapping、rviz

roslaunch turtlebot_navigation irobot_rplidar_gmapping_demo.launch

• 启动键盘操作irobot

roslaunch turtlebot_teleop keyboard_teleop.launch

• 建图结束后保存

mkdir -p ~/map
rosrun map_server map_saver -f ~/map/my_map
ls ~/map

记录建图数据

• 列出当前运行的topic

rostopic list -v

• 新建一个文件夹用于保存录制的内容，在该目录下运行

mkdir tempbagfiles
cd tempbagfiles
rosbag record -a

• 使用rosbag info检查bag文件

rosbag info

• 使用rosbag play命令回放,以再现系统运行过程

rosbag play

默认模式下，rosbag play命令在公告每条消息后会等待一小段时间（0.2秒）后才真正开始发布bag文件中的内容。等待时间可以通过-d选项来指定。你可以通过-s参数选项让rosbag play命令等待一段时间跳过bag文件初始部分后再真正开始回放。最后一个可能比较有趣的参数选项是-r选项，它允许你通过设定一个参数来改变消息发布速率。

• 数据提取

rostopic echo -b file.bag -p /topic > data.txt

• 地图创建

roscore
rosmake gmapping
rosparam set use_sim_time true

• 启动slam_gmapping

rosrun gmapping slam_gmapping scan:=base_scan

• 在一个新的终端回放bag文件

rosbag play –clock filename

• 使用map_server包的map_saver保存地图

rosrun map_server map_saver

• 查看地图的进展

rosrun rviz rviz