feat(franka_gazebo): add incompatibly physics engine warning

frankaemika · Dec 10, 2021 · d547046 · d547046
1 parent 3a63dda
commit d547046
Showing 1 changed file with 9 additions and 0 deletions.
diff --git a/franka_gazebo/src/franka_hw_sim.cpp b/franka_gazebo/src/franka_hw_sim.cpp
@@ -39,7 +39,16 @@ bool FrankaHWSim::initSim(const std::string& robot_namespace,
   gazebo::physics::PhysicsEnginePtr physics = gazebo::physics::get_world()->GetPhysicsEngine();
 #endif
 
+  // Print information about the used physics engine
+  std::vector<std::string> supported_engines{"ode", "dart"};
+  std::string physics_engine = physics->GetType();
   ROS_INFO_STREAM_NAMED("franka_hw_sim", "Using physics type " << physics->GetType());
+  if (std::find(supported_engines.begin(), supported_engines.end(), physics_engine) ==
+      supported_engines.end()) {
+    ROS_ERROR_STREAM_NAMED("franka_hw_sim",
+                           "The Panda Gazebo model does not yet officially support the '" +
+                               physics_engine + "' physics engine.");
+  }
 
   // Retrieve initial gravity vector from Gazebo
   // NOTE: Can be overwritten by the user via the 'gravity_vector' ROS parameter.