Revert "Don't assert when getting World frame info"

This reverts commit 37d09ae. Signed-off-by: Steven Peters <[email protected]>
gazebosim · Jul 15, 2021 · 5261eee · 5261eee
1 parent 37d09ae
commit 5261eee
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/dartsim/src/KinematicsFeatures.cc b/dartsim/src/KinematicsFeatures.cc
@@ -30,8 +30,12 @@ FrameData3d KinematicsFeatures::FrameDataRelativeToWorld(
 {
   FrameData3d data;
 
+  // The feature system should never send us the world ID.
   if (_id.IsWorld())
   {
+    ignerr << "Given a FrameID belonging to the world. This should not be "
+           << "possible! Please report this bug!\n";
+    assert(false);
     return data;
   }