最新消息:

ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

ROBOTS/其他机器人 少儿编程 1686浏览 0评论
ROS机器人Diego制作

ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

说明:

  • 介绍如何用F4激光雷达的hector算法创建创建室内地图
  • 今天我们就用这款雷达基于ROS的 hector来创建室内地图,先上创建好的室内地图。

步骤:

  • 图示:

ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

  • 此图是diego 1#搭载此雷达使用hector创建的。

  • 下载F4的ROS包,执行如下命令:

cd ~/catkin_ws/src
git clone https://github.com/EAIBOT/flashgo.git
cd ..
catkin_make
  • 执行完成后在src目录下增加一个flashgo的目录,就是F4的ROS包
  • 图示:

ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

  • 修改配置文件中的串口号

  • F4采用的USB和主板连接,和树莓派连接后,会在系统中出现一个串口,由于Arduino UNO也是通过USB连接串口通信,所以在系统中会出现两个串口设备,在配置中一定区分清楚两个设备对应的串口号

  • 图示:
    ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

  • 如上图ttyACM0, 和ttyACM1就是对应的串口号,在diego1#中ttyACM1对应的是arduino,ttyACM0对应的F4激光雷达,我们需要修改对应的参数,首先修改Ardunio的配置文件,在config目录打开my_arduino_params.yaml

  • 图示:
    ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

  • 修改arduino_bridge连接的串口为ttyACM1

  • 图示:
    ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

  • 修改F4的配置文件,打开flashgo/launch目录下的lidar.launch文件

  • 图示:
    ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

  • 修改F4连接的串口为ttyACM0

  • 图示:
    ROS机器人Diego制作20-搭载EAI F4激光雷达Hector创建室内地图

编写launch文件

  • 创建diego_run_hector_flashgo.launch文件
  • 代码如下:
<?xml version="1.0"?>

<launch>
  <arg name="tf_map_scanmatch_transform_frame_name" default="/scanmatcher_frame"/>
  <arg name="pub_map_odom_transform" value="true"/> 
  <arg name="map_frame" value="map"/> 
  <arg name="base_frame" value="base_link"/> 
  <arg name="odom_frame" value="base_link"/>
  <arg name="scan_subscriber_queue_size" default="5"/>
  <arg name="scan_topic" default="scan"/>
  <arg name="map_size" default="2048"/>

  <master auto="start"/>

  <include file="$(find flashgo)/launch/lidar.launch" />

  <node name="arduino" pkg="ros_arduino_python" type="arduino_node.py" output="screen">
      <rosparam file="$(find ros_arduino_python)/config/my_arduino_params.yaml" command="load" />
  </node> 

  <node pkg="tf" type="static_transform_publisher" name="base_frame_2_laser" args="0 0 0 0 0 0 /$(arg base_frame) /laser 100"/>  
  <node pkg="tf" type="static_transform_publisher" name="map_2_odom" args="0.0 0.0 0.0 0 0 0.0 /odom /$(arg base_frame) 10"/>


  <node pkg="hector_mapping" type="hector_mapping" name="hector_mapping" output="screen">   
  <!-- Frame names -->
  <param name="map_frame" value="$(arg map_frame)" />
  <param name="base_frame" value="$(arg base_frame)" />
  <param name="odom_frame" value="$(arg base_frame)" />   
   <!-- Tf use -->
  <param name="use_tf_scan_transformation" value="true"/>
  <param name="use_tf_pose_start_estimate" value="false"/>
  <param name="pub_map_odom_transform" value="$(arg pub_map_odom_transform)"/> 
  <!-- Map size / start point -->
  <param name="map_resolution" value="0.050"/>
  <param name="map_size" value="$(arg map_size)"/>
  <param name="map_start_x" value="0.5"/>
  <param name="map_start_y" value="0.5" />
  <param name="map_multi_res_levels" value="2" />
  <!-- Map update parameters -->
  <param name="update_factor_free" value="0.4"/>
  <param name="update_factor_occupied" value="0.7" />   
  <param name="map_update_distance_thresh" value="0.2"/>
  <param name="map_update_angle_thresh" value="0.9" />
  <param name="laser_z_min_value" value = "-1.0" />
  <param name="laser_z_max_value" value = "1.0" />  
  <!-- Advertising config -->
  <param name="advertise_map_service" value="true"/>
  <param name="scan_subscriber_queue_size" value="$(arg scan_subscriber_queue_size)"/>
  <param name="scan_topic" value="$(arg scan_topic)"/>
  <param name="tf_map_scanmatch_transform_frame_name" value="$(arg tf_map_scanmatch_transform_frame_name)" />
  </node>

  <include file="$(find hector_geotiff)/launch/geotiff_mapper.launch"/> 

</launch>

测试

  • 现在就可以执行如下代码,来启动激光雷达
roslaunch diego_nav diego_run_hector_flashgo.launch
  • 绘制地图
  • 这时我们可以通过键盘控制diego#在房间内运动,启动rviz就可以绘制出相应的地图,在不同终端中执行如下命令
rosrun teleop_twist_keyboard teleop_twist_keyboard.py
rosrun rviz rviz

您必须 登录 才能发表评论!