From be5b6813a9675089f6ea0ee02a1e6eefed831e49 Mon Sep 17 00:00:00 2001 From: Sébastien Crozet Date: Fri, 24 Jun 2022 11:56:28 +0200 Subject: Broad-phase: discard NAN/Inf AABBs. --- src/geometry/broad_phase_multi_sap/broad_phase.rs | 10 +++++++++- 1 file changed, 9 insertions(+), 1 deletion(-) (limited to 'src/geometry') diff --git a/src/geometry/broad_phase_multi_sap/broad_phase.rs b/src/geometry/broad_phase_multi_sap/broad_phase.rs index 2c8c5e3..60a28bd 100644 --- a/src/geometry/broad_phase_multi_sap/broad_phase.rs +++ b/src/geometry/broad_phase_multi_sap/broad_phase.rs @@ -8,7 +8,7 @@ use crate::geometry::{ }; use crate::math::Real; use crate::utils::IndexMut2; -use parry::bounding_volume::BoundingVolume; +use parry::bounding_volume::{BoundingVolume, AABB}; use parry::utils::hashmap::HashMap; /// A broad-phase combining a Hierarchical Grid and Sweep-and-Prune. @@ -352,8 +352,16 @@ impl BroadPhase { .compute_aabb(co_pos) .loosened(prediction_distance / 2.0); + if aabb.mins.coords.iter().any(|e| !e.is_finite()) + || aabb.maxs.coords.iter().any(|e| !e.is_finite()) + { + // Reject AABBs with non-finite values. + return false; + } + aabb.mins = super::clamp_point(aabb.mins); aabb.maxs = super::clamp_point(aabb.maxs); + let prev_aabb; let layer_id = if let Some(proxy) = self.proxies.get_mut(*proxy_index) { -- cgit