initial target and source vectors based on config parameters

ros-perception · Dec 7, 2022 · 86caf8f · 86caf8f
1 parent 090ca8d
commit 86caf8f
Showing 1 changed file with 10 additions and 0 deletions.
diff --git a/image_rotate/src/image_rotate_node.cpp b/image_rotate/src/image_rotate_node.cpp
@@ -136,6 +136,16 @@ ImageRotateNode::ImageRotateNode()
     };
   on_set_parameters_callback_handle_ = this->add_on_set_parameters_callback(reconfigureCallback);
   onInit();
+
+  // Set initial target and source based on config parameters
+  target_vector_.vector.x = config_.target_x;
+  target_vector_.vector.y = config_.target_y;
+  target_vector_.vector.z = config_.target_z;
+
+  source_vector_.vector.x = config_.source_x;
+  source_vector_.vector.y = config_.source_y;
+  source_vector_.vector.z = config_.source_z;
+
 }
 
 const std::string ImageRotateNode::frameWithDefault(