Temporary fix for gazebosim#2165 until gazebosim#2217 is resolved.

Signed-off-by: Johan Rutgeerts <[email protected]>
jrutgeer · Nov 21, 2023 · a89796c · a89796c
1 parent 14f8796
commit a89796c
Showing 1 changed file with 13 additions and 0 deletions.
diff --git a/src/systems/joint_position_controller/JointPositionController.cc b/src/systems/joint_position_controller/JointPositionController.cc
@@ -320,6 +320,19 @@ void JointPositionController::PreUpdate(
 {
   GZ_PROFILE("JointPositionController::PreUpdate");
 
+  if (kNullEntity == this->dataPtr->model.Entity())
+  {
+    return;
+  }
+
+  if (!this->dataPtr->model.Valid(_ecm))
+  {
+    gzwarn << "JointPositionController model no longer valid. "
+           << "Disabling plugin." << std::endl;
+    this->dataPtr->model = Model(kNullEntity);
+    return;
+  }
+
   // \TODO(anyone) Support rewind
   if (_info.dt < std::chrono::steady_clock::duration::zero())
   {