update

examples/NavigationExample/Program.cs

@@ -404,17 +404,19 @@ namespace NavigationExample
             goal.pose.orientation.z = 0.0;
             goal.pose.orientation.w = 1.0;
 
-            NavigationAPI.navigation_dock_to_order(navHandle, order, "docking_point", goal);
 
-            // NavigationAPI.navigation_move_to_order(navHandle, order, goal);`
+            Console.WriteLine("Docking to docking_point");
+            NavigationAPI.navigation_dock_to_order(navHandle, order, "charger", goal);
+
+            // NavigationAPI.navigation_move_to_order(navHandle, order, goal);
             NavigationAPI.navigation_set_twist_linear(navHandle, 0.1, 0.0, 0.0);
             NavigationAPI.navigation_set_twist_angular(navHandle, 0.0, 0.0, 0.2);
 
             // NavigationAPI.navigation_move_straight_to(navHandle, 1.0);
 
-            // while (true) 
-            // {
-            //     System.Threading.Thread.Sleep(100);
+            while (true) 
+            {
+                System.Threading.Thread.Sleep(100);
             //     NavigationAPI.NavFeedback feedback = new NavigationAPI.NavFeedback();
             //     if (NavigationAPI.navigation_get_feedback(navHandle, ref feedback))
             //     {
@@ -474,7 +476,7 @@ namespace NavigationExample
             //             Console.WriteLine("Local Costmap is not updated");
             //         }
             //     }
-            // }
+            }
             // Cleanup (destroy nav first, then tf3 buffer)
 
             NavigationAPI.navigation_destroy(navHandle);