Include broken values in assertion failure message.

1 files changed, 14 insertions, 2 deletions

diff --git a/src/geometry/broad_phase_multi_sap/sap_axis.rs b/src/geometry/broad_phase_multi_sap/sap_axis.rs
index a6b62ae..4b05116 100644
--- a/src/geometry/broad_phase_multi_sap/sap_axis.rs
+++ b/src/geometry/broad_phase_multi_sap/sap_axis.rs
@@ -51,8 +51,20 @@ impl SAPAxis {
 
         for proxy_id in new_proxies {
             let proxy = &proxies[*proxy_id];
-            assert!(proxy.aabb.mins[dim] <= self.max_bound);
-            assert!(proxy.aabb.maxs[dim] >= self.min_bound);
+            assert!(
+                proxy.aabb.mins[dim] <= self.max_bound,
+                "proxy.aabb.mins {} (in {:?}) <= max_bound {}",
+                proxy.aabb.mins[dim],
+                proxy.aabb,
+                self.max_bound
+            );
+            assert!(
+                proxy.aabb.maxs[dim] >= self.min_bound,
+                "proxy.aabb.maxs {} (in {:?}) >= min_bound {}",
+                proxy.aabb.maxs[dim],
+                proxy.aabb,
+                self.min_bound
+            );
             let start_endpoint =
                 SAPEndpoint::start_endpoint(proxy.aabb.mins[dim], *proxy_id as u32);
             let end_endpoint = SAPEndpoint::end_endpoint(proxy.aabb.maxs[dim], *proxy_id as u32);