Clean shutdown position example (#196)

Signed-off-by: Alejandro Hernández Cordero <[email protected]>

Author: ahcorde

gazebo_ros2_control_demos/examples/example_position.cpp

@@ -149,6 +149,8 @@ int main(int argc, char * argv[])
     rclcpp::FutureReturnCode::SUCCESS)
   {
     RCLCPP_ERROR(node->get_logger(), "send goal call failed :(");
+    action_client.reset();
+    node.reset();
     return 1;
   }
   RCLCPP_INFO(node->get_logger(), "send goal call ok :)");
@@ -157,6 +159,8 @@ int main(int argc, char * argv[])
     goal_handle = goal_handle_future.get();
   if (!goal_handle) {
     RCLCPP_ERROR(node->get_logger(), "Goal was rejected by server");
+    action_client.reset();
+    node.reset();
     return 1;
   }
   RCLCPP_INFO(node->get_logger(), "Goal was accepted by server");
@@ -171,7 +175,8 @@ int main(int argc, char * argv[])
     return 1;
   }
 
-  std::cout << "async_send_goal" << std::endl;
+  action_client.reset();
+  node.reset();
   rclcpp::shutdown();
 
   return 0;