diff --git a/src/dynamics/solver/interaction_groups.rs b/src/dynamics/solver/interaction_groups.rs index 1e834e6a3..c3345948b 100644 --- a/src/dynamics/solver/interaction_groups.rs +++ b/src/dynamics/solver/interaction_groups.rs @@ -437,6 +437,11 @@ impl InteractionGroups { let i1 = active_set_offset1; let i2 = active_set_offset2; + + if i1 >= self.body_masks.len() || i2 >= self.body_masks.len() { + continue; + } + let mask1 = if !is_fixed1 { self.body_masks[i1] } else { 0 }; let mask2 = if !is_fixed2 { self.body_masks[i2] } else { 0 }; let conflicts = mask1 | mask2;