Fix goal handle was not freed correctly (ros-navigation#4137) (ros-na…

…vigation#4143)

* Fix goal handle was not freed correctly

* Update nav2_util/include/nav2_util/simple_action_server.hpp

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>

---------

Signed-off-by: Steve Macenski <stevenmacenski@gmail.com>
Co-authored-by: Ziohang <hang.zhou@agvsz.com>
Co-authored-by: Steve Macenski <stevenmacenski@gmail.com>
(cherry picked from commit 2e491b1)

Co-authored-by: iceuw <m201770623@hust.edu.cn>

nav2_util/include/nav2_util/simple_action_server.hpp

@@ -549,7 +549,7 @@ class SimpleActionServer
    * @param the Results object to terminate the action with
    */
   void terminate(
-    std::shared_ptr<rclcpp_action::ServerGoalHandle<ActionT>> handle,
+    std::shared_ptr<rclcpp_action::ServerGoalHandle<ActionT>> & handle,
     typename std::shared_ptr<typename ActionT::Result> result =
     std::make_shared<typename ActionT::Result>())
   {