Simulation environment state monitor node added for detect models placement without sensors

robossembler_scene_monitor/scene_monitor/include/component.hpp

@@ -1,7 +1,9 @@
 #pragma once
 
 #include <string>
+#include <geometry_msgs/msg/pose_stamped.hpp>
 #include <geometry_msgs/msg/pose.hpp>
+
 #include "scene_monitor_interfaces/msg/grasp_pose.hpp"
 #include "nlohmann_json/json.hpp"
 
@@ -19,6 +21,7 @@ Description:
     Posted:
         - model is posted with another
 */
+
 enum ComponentState
 {
     Initialized,
@@ -45,7 +48,6 @@ public:
 
     void updateState(const ComponentState &state);
 
-
 private:
 
     std::string _frame_name;
@@ -53,6 +55,7 @@ private:
     geometry_msgs::msg::Pose _placement;
     std::map<std::string, scene_monitor_interfaces::msg::GraspPose> _grasp_poses;
 
+    geometry_msgs::msg::Pose _current_pose;
 };
 
 }