Draft: Added GoalUpdatedController BT plugin node (ros-navigation#3044) (ros-navigation#3058)

* first draft for goal updated controller

Signed-off-by: relffok <57466265+relffok@users.noreply.github.com>

* added goal_updated_controller to all yamls

* added GoalUpdatedController API

* added GoaUpdatedController to default plugins

* removed first_time param

* added test for GoalUpdatedController

* linter fix

Co-authored-by: relffok <57466265+relffok@users.noreply.github.com>

Author: 2 people

nav2_behavior_tree/nav2_tree_nodes.xml

@@ -304,5 +304,8 @@
     <Decorator ID="GoalUpdatedController">
     </Decorator>
 
+    <Decorator ID="GoalUpdatedController">
+    </Decorator>
+
   </TreeNodesModel>
 </root>