From bf42dfd1395064b4e8669166d26290f6f3f30b41 Mon Sep 17 00:00:00 2001
From: hello-binit <64861565+hello-binit@users.noreply.github.com>
Date: Sat, 31 Jul 2021 01:14:42 -0400
Subject: [PATCH] Add simulated mapping to Stretch Navigation

---
 .../launch/mapping_gazebo.launch              | 28 +++++++++++++++++++
 1 file changed, 28 insertions(+)
 create mode 100644 stretch_navigation/launch/mapping_gazebo.launch

diff --git a/stretch_navigation/launch/mapping_gazebo.launch b/stretch_navigation/launch/mapping_gazebo.launch
new file mode 100644
index 0000000..cf7e39b
--- /dev/null
+++ b/stretch_navigation/launch/mapping_gazebo.launch
@@ -0,0 +1,28 @@
+<launch>
+
+  <arg name="rviz" default="true"/>
+  <arg name="gazebo_gpu_lidar" default="false"/>
+  <arg name="gazebo_visualize_lidar" default="false"/>
+  <arg name="gazebo_world" default="worlds/empty.world"/>
+
+  <!-- GAZEBO SIMULATION -->
+  <include file="$(find stretch_gazebo)/launch/gazebo.launch">
+    <arg name="world" value="$(arg gazebo_world)" />
+    <arg name="visualize_lidar" value="$(arg gazebo_visualize_lidar)" />
+    <arg name="gpu_lidar" value="$(arg gazebo_gpu_lidar)" />
+  </include>
+
+  <!-- TELEOP -->
+  <node name="teleop_twist_keyboard" pkg="teleop_twist_keyboard" type="teleop_twist_keyboard.py" output="screen" >
+    <param name="speed" type="double" value="1.0" />
+    <param name="turn" type="double" value="2.0" />
+    <remap from="/cmd_vel" to="/stretch_diff_drive_controller/cmd_vel" />
+  </node>
+
+  <!-- RVIZ -->
+  <node name="rviz" pkg="rviz" type="rviz" output="log" args="-d $(find stretch_navigation)/rviz/mapping.rviz" if="$(arg rviz)" />
+
+  <!-- GMAPPING -->
+  <node pkg="gmapping" type="slam_gmapping" name="gmapping_record_map" output="log" />
+
+</launch>