diff --git a/rviz/ana.rviz b/rviz/ana.rviz
index 2e96a07236a7f8cfb5c2d64fe62f9ab9136a3398..bdce0f75ea45954ca97e7b3ec217947990e90186 100644
--- a/rviz/ana.rviz
+++ b/rviz/ana.rviz
@@ -6,10 +6,8 @@ Panels:
       Expanded:
         - /Sensors1
         - /Nav1
-        - /AMCL1
-        - /Exploration1
-      Splitter Ratio: 0.553314149
-    Tree Height: 663
+      Splitter Ratio: 0.5533141493797302
+    Tree Height: 653
   - Class: rviz/Selection
     Name: Selection
   - Class: rviz/Tool Properties
@@ -18,17 +16,18 @@ Panels:
       - /2D Nav Goal1
       - /Publish Point1
     Name: Tool Properties
-    Splitter Ratio: 0.588679016
+    Splitter Ratio: 0.5886790156364441
   - Class: rviz/Views
     Expanded:
       - /Current View1
     Name: Views
     Splitter Ratio: 0.5
   - Class: rviz/Time
-    Experimental: false
     Name: Time
     SyncMode: 0
     SyncSource: LaserScan
+Preferences:
+  PromptSaveOnExit: true
 Toolbars:
   toolButtonStyle: 2
 Visualization Manager:
@@ -40,7 +39,7 @@ Visualization Manager:
       Color: 160; 160; 164
       Enabled: true
       Line Style:
-        Line Width: 0.0299999993
+        Line Width: 0.029999999329447746
         Value: Lines
       Name: Grid
       Normal Cell Count: 0
@@ -80,141 +79,95 @@ Visualization Manager:
           Show Axes: false
           Show Trail: false
           Value: true
-        camera_bottom_screw_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_color_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_color_optical_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_depth_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_depth_optical_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_infra1_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_infra1_optical_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_infra2_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_infra2_optical_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_link:
+        front_left_axle:
           Alpha: 1
           Show Axes: false
           Show Trail: false
           Value: true
-        camera_pan_tilt_bottom_screw_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_pan_tilt_color_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-        camera_pan_tilt_color_optical_frame:
+        front_left_hub:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        camera_pan_tilt_depth_frame:
+          Value: true
+        front_left_wheel:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        camera_pan_tilt_depth_optical_frame:
+          Value: true
+        front_right_axle:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        camera_pan_tilt_infra1_frame:
+          Value: true
+        front_right_hub:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        camera_pan_tilt_infra1_optical_frame:
+          Value: true
+        front_right_wheel:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        camera_pan_tilt_infra2_frame:
+          Value: true
+        front_sonar:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        camera_pan_tilt_infra2_optical_frame:
+          Value: true
+        imu_bno055:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        camera_pan_tilt_link:
+        imu_sim_bno055:
           Alpha: 1
           Show Axes: false
           Show Trail: false
           Value: true
-        front_left_axle:
+        imu_sim_bno055_base:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        front_left_hub:
+        nav_cam_bottom_screw_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        front_left_wheel:
+        nav_cam_color_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        front_right_axle:
+        nav_cam_color_optical_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        front_right_hub:
+        nav_cam_depth_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        front_right_wheel:
+        nav_cam_depth_optical_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        front_sonar:
+        nav_cam_infra1_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        imu_bno055:
+        nav_cam_infra1_optical_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        imu_bno055_base:
+        nav_cam_infra2_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-        pan_frame:
+        nav_cam_infra2_optical_frame:
           Alpha: 1
           Show Axes: false
           Show Trail: false
-          Value: true
-        realsense_support_pan_tilt:
+        nav_cam_link:
           Alpha: 1
           Show Axes: false
           Show Trail: false
+          Value: true
         rear_left_axle:
           Alpha: 1
           Show Axes: false
@@ -250,11 +203,6 @@ Visualization Manager:
           Show Axes: false
           Show Trail: false
           Value: true
-        tilt_frame:
-          Alpha: 1
-          Show Axes: false
-          Show Trail: false
-          Value: true
         top_plate:
           Alpha: 1
           Show Axes: false
@@ -289,70 +237,48 @@ Visualization Manager:
           Value: true
         ana/base_link:
           Value: true
-        ana/camera_bottom_screw_frame:
-          Value: true
-        ana/camera_color_frame:
-          Value: true
-        ana/camera_color_optical_frame:
-          Value: true
-        ana/camera_depth_frame:
-          Value: true
-        ana/camera_depth_optical_frame:
-          Value: true
-        ana/camera_infra1_frame:
-          Value: true
-        ana/camera_infra1_optical_frame:
-          Value: true
-        ana/camera_infra2_frame:
-          Value: true
-        ana/camera_infra2_optical_frame:
-          Value: true
-        ana/camera_link:
+        ana/front_left_axle:
           Value: true
-        ana/camera_pan_tilt_bottom_screw_frame:
+        ana/front_left_hub:
           Value: true
-        ana/camera_pan_tilt_color_frame:
+        ana/front_left_wheel:
           Value: true
-        ana/camera_pan_tilt_color_optical_frame:
+        ana/front_right_axle:
           Value: true
-        ana/camera_pan_tilt_depth_frame:
+        ana/front_right_hub:
           Value: true
-        ana/camera_pan_tilt_depth_optical_frame:
+        ana/front_right_wheel:
           Value: true
-        ana/camera_pan_tilt_infra1_frame:
+        ana/front_sonar:
           Value: true
-        ana/camera_pan_tilt_infra1_optical_frame:
+        ana/imu_bno055:
           Value: true
-        ana/camera_pan_tilt_infra2_frame:
+        ana/imu_sim_bno055:
           Value: true
-        ana/camera_pan_tilt_infra2_optical_frame:
+        ana/imu_sim_bno055_base:
           Value: true
-        ana/camera_pan_tilt_link:
+        ana/nav_cam_bottom_screw_frame:
           Value: true
-        ana/front_left_axle:
+        ana/nav_cam_color_frame:
           Value: true
-        ana/front_left_hub:
+        ana/nav_cam_color_optical_frame:
           Value: true
-        ana/front_left_wheel:
+        ana/nav_cam_depth_frame:
           Value: true
-        ana/front_right_axle:
+        ana/nav_cam_depth_optical_frame:
           Value: true
-        ana/front_right_hub:
+        ana/nav_cam_infra1_frame:
           Value: true
-        ana/front_right_wheel:
+        ana/nav_cam_infra1_optical_frame:
           Value: true
-        ana/front_sonar:
+        ana/nav_cam_infra2_frame:
           Value: true
-        ana/imu_bno055:
+        ana/nav_cam_infra2_optical_frame:
           Value: true
-        ana/imu_bno055_base:
+        ana/nav_cam_link:
           Value: true
         ana/odom:
           Value: true
-        ana/pan_frame:
-          Value: true
-        ana/realsense_support_pan_tilt:
-          Value: true
         ana/rear_left_axle:
           Value: true
         ana/rear_left_hub:
@@ -367,8 +293,6 @@ Visualization Manager:
           Value: true
         ana/rear_sonar:
           Value: true
-        ana/tilt_frame:
-          Value: true
         ana/top_plate:
           Value: true
         ana/velodyne:
@@ -379,7 +303,10 @@ Visualization Manager:
           Value: true
         world:
           Value: true
-      Marker Scale: 0.100000001
+        world_body:
+          Value: true
+      Marker Alpha: 1
+      Marker Scale: 0.10000000149011612
       Name: TF
       Show Arrows: true
       Show Axes: true
@@ -411,46 +338,33 @@ Visualization Manager:
                   {}
                 ana/top_plate:
                   ana/ana_box:
-                    ana/pan_frame:
-                      ana/tilt_frame:
-                        ana/realsense_support_pan_tilt:
-                          ana/camera_pan_tilt_bottom_screw_frame:
-                            ana/camera_pan_tilt_link:
-                              ana/camera_pan_tilt_color_frame:
-                                ana/camera_pan_tilt_color_optical_frame:
-                                  {}
-                              ana/camera_pan_tilt_depth_frame:
-                                ana/camera_pan_tilt_depth_optical_frame:
-                                  {}
-                              ana/camera_pan_tilt_infra1_frame:
-                                ana/camera_pan_tilt_infra1_optical_frame:
-                                  {}
-                              ana/camera_pan_tilt_infra2_frame:
-                                ana/camera_pan_tilt_infra2_optical_frame:
-                                  {}
+                    {}
                   ana/ana_realsense_support:
-                    ana/camera_bottom_screw_frame:
-                      ana/camera_link:
-                        ana/camera_color_frame:
-                          ana/camera_color_optical_frame:
+                    ana/nav_cam_bottom_screw_frame:
+                      ana/nav_cam_link:
+                        ana/nav_cam_color_frame:
+                          ana/nav_cam_color_optical_frame:
                             {}
-                        ana/camera_depth_frame:
-                          ana/camera_depth_optical_frame:
+                        ana/nav_cam_depth_frame:
+                          ana/nav_cam_depth_optical_frame:
                             {}
-                        ana/camera_infra1_frame:
-                          ana/camera_infra1_optical_frame:
+                        ana/nav_cam_infra1_frame:
+                          ana/nav_cam_infra1_optical_frame:
                             {}
-                        ana/camera_infra2_frame:
-                          ana/camera_infra2_optical_frame:
+                        ana/nav_cam_infra2_frame:
+                          ana/nav_cam_infra2_optical_frame:
                             {}
                   ana/velodyne_base:
                     ana/velodyne:
                       {}
-              ana/imu_bno055_base:
-                ana/imu_bno055:
+              ana/imu_bno055:
+                {}
+              ana/imu_sim_bno055_base:
+                ana/imu_sim_bno055:
                   {}
           world:
-            {}
+            world_body:
+              {}
       Update Interval: 0
       Value: true
     - Class: rviz/Group
@@ -467,7 +381,7 @@ Visualization Manager:
               Scale: 1
               Value: true
             Position:
-              Alpha: 0.300000012
+              Alpha: 0.30000001192092896
               Color: 204; 51; 204
               Scale: 1
               Value: true
@@ -476,15 +390,16 @@ Visualization Manager:
           Keep: 100
           Name: Odometry
           Position Tolerance: 0.5
+          Queue Size: 10
           Shape:
             Alpha: 1
             Axes Length: 1
-            Axes Radius: 0.100000001
+            Axes Radius: 0.10000000149011612
             Color: 255; 25; 0
-            Head Length: 0.150000006
-            Head Radius: 0.0500000007
+            Head Length: 0.15000000596046448
+            Head Radius: 0.05000000074505806
             Shaft Length: 0.5
-            Shaft Radius: 0.0250000004
+            Shaft Radius: 0.02500000037252903
             Value: Arrow
           Topic: /ana/odom
           Unreliable: false
@@ -501,7 +416,7 @@ Visualization Manager:
           Transport Hint: raw
           Unreliable: false
           Value: true
-        - Alpha: 0.100000001
+        - Alpha: 0.10000000149011612
           Autocompute Intensity Bounds: true
           Autocompute Value Bounds:
             Max Value: 10
@@ -516,15 +431,13 @@ Visualization Manager:
           Enabled: true
           Invert Rainbow: false
           Max Color: 255; 255; 255
-          Max Intensity: 4096
           Min Color: 0; 0; 0
-          Min Intensity: 0
           Name: realsense_pointcloud
           Position Transformer: XYZ
           Queue Size: 10
           Selectable: true
           Size (Pixels): 5
-          Size (m): 0.00999999978
+          Size (m): 0.009999999776482582
           Style: Points
           Topic: /ana/sensors/nav_cam/depth_registered/points
           Unreliable: false
@@ -534,8 +447,8 @@ Visualization Manager:
         - Alpha: 1
           Autocompute Intensity Bounds: true
           Autocompute Value Bounds:
-            Max Value: 3.4000001
-            Min Value: -0.180000007
+            Max Value: 3.4000000953674316
+            Min Value: -0.18000000715255737
             Value: false
           Axis: Z
           Channel Name: intensity
@@ -546,15 +459,13 @@ Visualization Manager:
           Enabled: true
           Invert Rainbow: false
           Max Color: 255; 255; 255
-          Max Intensity: 0
           Min Color: 0; 0; 0
-          Min Intensity: 0
           Name: Velodyne
           Position Transformer: XYZ
           Queue Size: 10
           Selectable: true
           Size (Pixels): 3
-          Size (m): 0.00999999978
+          Size (m): 0.009999999776482582
           Style: Points
           Topic: /ana/sensors/velodyne_points
           Unreliable: false
@@ -576,15 +487,13 @@ Visualization Manager:
           Enabled: true
           Invert Rainbow: false
           Max Color: 255; 255; 255
-          Max Intensity: 4096
           Min Color: 0; 0; 0
-          Min Intensity: 0
           Name: LaserScan
           Position Transformer: XYZ
           Queue Size: 10
           Selectable: true
           Size (Pixels): 3
-          Size (m): 0.00999999978
+          Size (m): 0.009999999776482582
           Style: Points
           Topic: /ana/sensors/scan
           Unreliable: false
@@ -597,11 +506,89 @@ Visualization Manager:
           Enabled: false
           History Length: 1
           Name: Imu
+          Queue Size: 10
           Topic: /ana/sensors/imu
           Unreliable: false
           Value: false
       Enabled: false
       Name: Sensors
+    - Class: rviz/Group
+      Displays:
+        - Alpha: 0.699999988079071
+          Class: rviz/Map
+          Color Scheme: map
+          Draw Behind: true
+          Enabled: true
+          Name: Map
+          Topic: /ana/map
+          Unreliable: false
+          Use Timestamp: false
+          Value: true
+        - Alpha: 1
+          Autocompute Intensity Bounds: true
+          Autocompute Value Bounds:
+            Max Value: 10
+            Min Value: -10
+            Value: true
+          Axis: Z
+          Channel Name: intensity
+          Class: rviz/LaserScan
+          Color: 255; 0; 0
+          Color Transformer: FlatColor
+          Decay Time: 0
+          Enabled: true
+          Invert Rainbow: false
+          Max Color: 255; 255; 255
+          Min Color: 0; 0; 0
+          Name: LaserScan
+          Position Transformer: XYZ
+          Queue Size: 10
+          Selectable: true
+          Size (Pixels): 3
+          Size (m): 0.009999999776482582
+          Style: Points
+          Topic: /ana/sensors/scan
+          Unreliable: false
+          Use Fixed Frame: true
+          Use rainbow: true
+          Value: true
+        - Alpha: 0.5
+          Arrow Length: 0.05000000074505806
+          Axes Length: 0.30000001192092896
+          Axes Radius: 0.009999999776482582
+          Class: rviz/PoseArray
+          Color: 170; 85; 127
+          Enabled: true
+          Head Length: 0.07000000029802322
+          Head Radius: 0.029999999329447746
+          Name: AMCLPoseArray
+          Queue Size: 10
+          Shaft Length: 0.23000000417232513
+          Shaft Radius: 0.009999999776482582
+          Shape: Arrow (Flat)
+          Topic: /ana/particlecloud
+          Unreliable: false
+          Value: true
+        - Alpha: 1
+          Class: rviz/Axes
+          Enabled: true
+          Length: 1
+          Name: MapFrame
+          Radius: 0.10000000149011612
+          Reference Frame: map
+          Show Trail: false
+          Value: true
+        - Alpha: 1
+          Class: rviz/Axes
+          Enabled: true
+          Length: 1
+          Name: OdomFrame
+          Radius: 0.10000000149011612
+          Reference Frame: map
+          Show Trail: false
+          Value: true
+      Enabled: false
+      Name: AMCL
     - Class: rviz/Group
       Displays:
         - Angle Tolerance: 0.5
@@ -616,7 +603,7 @@ Visualization Manager:
               Scale: 1
               Value: true
             Position:
-              Alpha: 0.300000012
+              Alpha: 0.30000001192092896
               Color: 204; 51; 204
               Scale: 1
               Value: true
@@ -625,15 +612,16 @@ Visualization Manager:
           Keep: 100
           Name: Odometry
           Position Tolerance: 0.5
+          Queue Size: 10
           Shape:
             Alpha: 1
             Axes Length: 1
-            Axes Radius: 0.100000001
+            Axes Radius: 0.10000000149011612
             Color: 255; 25; 0
-            Head Length: 0.150000006
-            Head Radius: 0.0500000007
+            Head Length: 0.15000000596046448
+            Head Radius: 0.05000000074505806
             Shaft Length: 0.5
-            Shaft Radius: 0.0250000004
+            Shaft Radius: 0.02500000037252903
             Value: Arrow
           Topic: /ana/odom
           Unreliable: false
@@ -653,22 +641,20 @@ Visualization Manager:
           Enabled: true
           Invert Rainbow: false
           Max Color: 255; 255; 255
-          Max Intensity: 4096
           Min Color: 0; 0; 0
-          Min Intensity: 0
           Name: LaserScan
           Position Transformer: XYZ
           Queue Size: 10
           Selectable: true
           Size (Pixels): 3
-          Size (m): 0.00999999978
+          Size (m): 0.009999999776482582
           Style: Points
           Topic: /ana/sensors/scan
           Unreliable: false
           Use Fixed Frame: true
           Use rainbow: true
           Value: true
-        - Alpha: 0.699999988
+        - Alpha: 0.699999988079071
           Class: rviz/Map
           Color Scheme: map
           Draw Behind: true
@@ -683,6 +669,7 @@ Visualization Manager:
           Color: 25; 255; 0
           Enabled: true
           Name: footprint
+          Queue Size: 10
           Topic: /ana/move_base/global_costmap/footprint
           Unreliable: false
           Value: true
@@ -696,7 +683,7 @@ Visualization Manager:
           Unreliable: false
           Use Timestamp: false
           Value: true
-        - Alpha: 0.300000012
+        - Alpha: 0.30000001192092896
           Class: rviz/Map
           Color Scheme: costmap
           Draw Behind: true
@@ -711,11 +698,11 @@ Visualization Manager:
           Class: rviz/Path
           Color: 0; 0; 255
           Enabled: true
-          Head Diameter: 0.300000012
-          Head Length: 0.200000003
-          Length: 0.300000012
+          Head Diameter: 0.30000001192092896
+          Head Length: 0.20000000298023224
+          Length: 0.30000001192092896
           Line Style: Lines
-          Line Width: 0.0299999993
+          Line Width: 0.029999999329447746
           Name: global_plan
           Offset:
             X: 0
@@ -723,9 +710,10 @@ Visualization Manager:
             Z: 0
           Pose Color: 255; 85; 255
           Pose Style: None
-          Radius: 0.0299999993
-          Shaft Diameter: 0.100000001
-          Shaft Length: 0.100000001
+          Queue Size: 10
+          Radius: 0.029999999329447746
+          Shaft Diameter: 0.10000000149011612
+          Shaft Length: 0.10000000149011612
           Topic: /ana/move_base/GlobalPlanner/plan
           Unreliable: false
           Value: true
@@ -734,11 +722,11 @@ Visualization Manager:
           Class: rviz/Path
           Color: 255; 0; 0
           Enabled: true
-          Head Diameter: 0.300000012
-          Head Length: 0.200000003
-          Length: 0.300000012
+          Head Diameter: 0.30000001192092896
+          Head Length: 0.20000000298023224
+          Length: 0.30000001192092896
           Line Style: Lines
-          Line Width: 0.0299999993
+          Line Width: 0.029999999329447746
           Name: local_plan
           Offset:
             X: 0
@@ -746,141 +734,31 @@ Visualization Manager:
             Z: 0
           Pose Color: 255; 85; 255
           Pose Style: None
-          Radius: 0.0299999993
-          Shaft Diameter: 0.100000001
-          Shaft Length: 0.100000001
+          Queue Size: 10
+          Radius: 0.029999999329447746
+          Shaft Diameter: 0.10000000149011612
+          Shaft Length: 0.10000000149011612
           Topic: /ana/move_base/DWAPlannerROS/local_plan
           Unreliable: false
           Value: true
         - Alpha: 1
           Axes Length: 1
-          Axes Radius: 0.100000001
+          Axes Radius: 0.10000000149011612
           Class: rviz/Pose
           Color: 255; 255; 0
           Enabled: true
-          Head Length: 0.300000012
-          Head Radius: 0.100000001
+          Head Length: 0.30000001192092896
+          Head Radius: 0.10000000149011612
           Name: CurrentGoal
+          Queue Size: 10
           Shaft Length: 1
-          Shaft Radius: 0.0500000007
+          Shaft Radius: 0.05000000074505806
           Shape: Arrow
           Topic: /ana/move_base/current_goal
           Unreliable: false
           Value: true
-      Enabled: false
+      Enabled: true
       Name: Nav
-    - Class: rviz/Group
-      Displays:
-        - Alpha: 0.699999988
-          Class: rviz/Map
-          Color Scheme: map
-          Draw Behind: true
-          Enabled: true
-          Name: Map
-          Topic: /ana/map
-          Unreliable: false
-          Use Timestamp: false
-          Value: true
-        - Alpha: 1
-          Autocompute Intensity Bounds: true
-          Autocompute Value Bounds:
-            Max Value: 10
-            Min Value: -10
-            Value: true
-          Axis: Z
-          Channel Name: intensity
-          Class: rviz/LaserScan
-          Color: 255; 0; 0
-          Color Transformer: FlatColor
-          Decay Time: 0
-          Enabled: true
-          Invert Rainbow: false
-          Max Color: 255; 255; 255
-          Max Intensity: 4096
-          Min Color: 0; 0; 0
-          Min Intensity: 0
-          Name: LaserScan
-          Position Transformer: XYZ
-          Queue Size: 10
-          Selectable: true
-          Size (Pixels): 3
-          Size (m): 0.00999999978
-          Style: Points
-          Topic: /ana/sensors/scan
-          Unreliable: false
-          Use Fixed Frame: true
-          Use rainbow: true
-          Value: true
-        - Alpha: 0.5
-          Arrow Length: 0.0500000007
-          Axes Length: 0.300000012
-          Axes Radius: 0.00999999978
-          Class: rviz/PoseArray
-          Color: 170; 85; 127
-          Enabled: true
-          Head Length: 0.0700000003
-          Head Radius: 0.0299999993
-          Name: AMCLPoseArray
-          Shaft Length: 0.230000004
-          Shaft Radius: 0.00999999978
-          Shape: Arrow (Flat)
-          Topic: /ana/particlecloud
-          Unreliable: false
-          Value: true
-        - Class: rviz/Axes
-          Enabled: true
-          Length: 1
-          Name: MapFrame
-          Radius: 0.100000001
-          Reference Frame: map
-          Value: true
-        - Class: rviz/Axes
-          Enabled: true
-          Length: 1
-          Name: OdomFrame
-          Radius: 0.100000001
-          Reference Frame: map
-          Value: true
-      Enabled: false
-      Name: AMCL
-    - Class: rviz/Group
-      Displays:
-        - Class: rviz/Marker
-          Enabled: true
-          Marker Topic: /exploration/candidate_marker
-          Name: CandidateMarker
-          Namespaces:
-            {}
-          Queue Size: 100
-          Value: true
-        - Alpha: 0.699999988
-          Class: rviz/Map
-          Color Scheme: map
-          Draw Behind: false
-          Enabled: true
-          Name: FrontiersMap
-          Topic: /exploration/frontiers_map
-          Unreliable: false
-          Use Timestamp: false
-          Value: true
-        - Class: rviz/Marker
-          Enabled: true
-          Marker Topic: /exploration/frontiers_marker
-          Name: FrontiersMarker
-          Namespaces:
-            {}
-          Queue Size: 100
-          Value: true
-        - Class: rviz/Marker
-          Enabled: true
-          Marker Topic: /exploration/text_marker
-          Name: TextMarker
-          Namespaces:
-            {}
-          Queue Size: 100
-          Value: true
-      Enabled: false
-      Name: Exploration
   Enabled: true
   Global Options:
     Background Color: 48; 48; 48
@@ -896,7 +774,10 @@ Visualization Manager:
     - Class: rviz/FocusCamera
     - Class: rviz/Measure
     - Class: rviz/SetInitialPose
+      Theta std deviation: 0.2617993950843811
       Topic: /ana/initialpose
+      X std deviation: 0.5
+      Y std deviation: 0.5
     - Class: rviz/SetGoal
       Topic: /ana/move_base_simple/goal
     - Class: rviz/PublishPoint
@@ -906,25 +787,25 @@ Visualization Manager:
   Views:
     Current:
       Class: rviz/Orbit
-      Distance: 38.4725838
+      Distance: 23.846031188964844
       Enable Stereo Rendering:
-        Stereo Eye Separation: 0.0599999987
+        Stereo Eye Separation: 0.05999999865889549
         Stereo Focal Distance: 1
         Swap Stereo Eyes: false
         Value: false
+      Field of View: 0.7853981852531433
       Focal Point:
-        X: -0.395226091
-        Y: 0.568072855
-        Z: 0.530640662
+        X: 0
+        Y: 0
+        Z: 0
       Focal Shape Fixed Size: false
-      Focal Shape Size: 0.0500000007
+      Focal Shape Size: 0.05000000074505806
       Invert Z Axis: false
       Name: Current View
-      Near Clip Distance: 0.00999999978
-      Pitch: 1.56479633
+      Near Clip Distance: 0.009999999776482582
+      Pitch: 0.7853981852531433
       Target Frame: ana/base_footprint
-      Value: Orbit (rviz)
-      Yaw: 4.73356247
+      Yaw: 0.7853981852531433
     Saved: ~
 Window Geometry:
   Displays:
@@ -932,7 +813,7 @@ Window Geometry:
   Height: 876
   Hide Left Dock: false
   Hide Right Dock: false
-  QMainWindow State: 000000ff00000000fd00000004000000000000016a00000326fc0200000009fb0000001200530065006c0065006300740069006f006e00000001e10000009b0000006100fffffffb0000001e0054006f006f006c002000500072006f007000650072007400690065007302000001ed000001df00000185000000a3fb000000120056006900650077007300200054006f006f02000001df000002110000018500000122fb000000200054006f006f006c002000500072006f0070006500720074006900650073003203000002880000011d000002210000017afb000000100044006900730070006c006100790073010000002800000326000000d700fffffffb0000002000730065006c0065006300740069006f006e00200062007500660066006500720200000138000000aa0000023a00000294fb00000014005700690064006500530074006500720065006f02000000e6000000d2000003ee0000030bfb0000000c004b0069006e0065006300740200000186000001060000030c00000261fb0000001e007200650061006c00730065006e00730065005f0063006f006c006f0072000000025f000000ef0000001600ffffff000000010000010f000003dafc0200000003fb0000001e0054006f006f006c002000500072006f00700065007200740069006500730100000041000000780000000000000000fb0000000a005600690065007700730000000028000003da000000ad00fffffffb0000001200530065006c0065006300740069006f006e010000025a000000b200000000000000000000000200000490000000a9fc0100000001fb0000000a00560069006500770073030000004e00000080000002e100000197000000030000073f0000003efc0100000002fb0000000800540069006d006500000000000000073f0000030000fffffffb0000000800540069006d006501000000000000045000000000000000000000034f0000032600000004000000040000000800000008fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000
+  QMainWindow State: 000000ff00000000fd00000004000000000000015600000316fc0200000009fb0000001200530065006c0065006300740069006f006e00000001e10000009b0000005c00fffffffb0000001e0054006f006f006c002000500072006f007000650072007400690065007302000001ed000001df00000185000000a3fb000000120056006900650077007300200054006f006f02000001df000002110000018500000122fb000000200054006f006f006c002000500072006f0070006500720074006900650073003203000002880000011d000002210000017afb000000100044006900730070006c006100790073010000003b00000316000000c700fffffffb0000002000730065006c0065006300740069006f006e00200062007500660066006500720200000138000000aa0000023a00000294fb00000014005700690064006500530074006500720065006f02000000e6000000d2000003ee0000030bfb0000000c004b0069006e0065006300740200000186000001060000030c00000261fb0000001e007200650061006c00730065006e00730065005f0063006f006c006f0072000000025f000000ef0000001600ffffff000000010000010f000003dafc0200000003fb0000001e0054006f006f006c002000500072006f00700065007200740069006500730100000041000000780000000000000000fb0000000a005600690065007700730000000028000003da000000a000fffffffb0000001200530065006c0065006300740069006f006e010000025a000000b200000000000000000000000200000490000000a9fc0100000001fb0000000a00560069006500770073030000004e00000080000002e100000197000000030000073f0000003efc0100000002fb0000000800540069006d006500000000000000073f0000035c00fffffffb0000000800540069006d00650100000000000004500000000000000000000003630000031600000004000000040000000800000008fc0000000100000002000000010000000a0054006f006f006c00730100000000ffffffff0000000000000000
   Selection:
     collapsed: false
   Time:
@@ -942,7 +823,7 @@ Window Geometry:
   Views:
     collapsed: false
   Width: 1215
-  X: 65
-  Y: 24
+  X: 67
+  Y: 0
   realsense_color:
     collapsed: false