Parry update (0.18?)

Cargo.toml

@@ -38,6 +38,12 @@ resolver = "2"
 #parry2d-f64 = { git = "https://github.com/dimforge/parry", branch = "master" }
 #parry3d-f64 = { git = "https://github.com/dimforge/parry", branch = "master" }
 
+
+parry2d = { git = "https://github.com/dimforge/parry" }
+parry3d = { git = "https://github.com/dimforge/parry" }
+parry2d-f64 = { git = "https://github.com/dimforge/parry" }
+parry3d-f64 = { git = "https://github.com/dimforge/parry" }
+
 # # For feature unstable-puffin-pr-235
 # # See https://github.com/dimforge/rapier/issues/760.
 # puffin_egui = { version = "0.29", optional = true, git = "https://github.com/Vrixyz/puffin.git", branch = "expose_ui_options" }

benchmarks3d/trimesh3.rs

@@ -38,7 +38,7 @@ pub fn init_world(testbed: &mut Testbed) {
 
     let rigid_body = RigidBodyBuilder::fixed();
     let handle = bodies.insert(rigid_body);
-    let collider = ColliderBuilder::trimesh(vertices, indices);
+    let collider = ColliderBuilder::trimesh(vertices, indices).unwrap();
     colliders.insert_with_parent(collider, handle, &mut bodies);
 
     /*

crates/rapier_testbed2d-f64/Cargo.toml

@@ -34,12 +34,12 @@ default = ["dim2"]
 dim2 = []
 parallel = ["rapier/parallel", "num_cpus"]
 other-backends = ["wrapped2d"]
-profiling = ["dep:puffin_egui", "profiling/profile-with-puffin"]
+profiler_ui = ["dep:puffin_egui", "profiling/profile-with-puffin"]
 # See https://github.com/dimforge/rapier/issues/760.
 unstable-puffin-pr-235 = []
 
 [package.metadata.docs.rs]
-features = ["parallel", "profiling"]
+features = ["parallel", "profiler_ui"]
 
 [lints.clippy]
 needless_lifetimes = "allow"

crates/rapier_testbed2d/Cargo.toml

@@ -34,12 +34,12 @@ default = ["dim2"]
 dim2 = []
 parallel = ["rapier/parallel", "num_cpus"]
 other-backends = ["wrapped2d"]
-profiling = ["dep:puffin_egui", "profiling/profile-with-puffin"]
+profiler_ui = ["dep:puffin_egui", "profiling/profile-with-puffin"]
 # See https://github.com/dimforge/rapier/issues/760.
 unstable-puffin-pr-235 = []
 
 [package.metadata.docs.rs]
-features = ["parallel", "other-backends", "profiling"]
+features = ["parallel", "other-backends", "profiler_ui"]
 
 [lints.clippy]
 needless_lifetimes = "allow"

crates/rapier_testbed3d-f64/Cargo.toml

@@ -36,12 +36,12 @@ rust.unexpected_cfgs = { level = "warn", check-cfg = [
 default = ["dim3"]
 dim3 = []
 parallel = ["rapier/parallel", "num_cpus"]
-profiling = ["dep:puffin_egui", "profiling/profile-with-puffin"]
+profiler_ui = ["dep:puffin_egui", "profiling/profile-with-puffin"]
 # See https://github.com/dimforge/rapier/issues/760.
 unstable-puffin-pr-235 = []
 
 [package.metadata.docs.rs]
-features = ["parallel", "profiling"]
+features = ["parallel", "profiler_ui"]
 
 [lints.clippy]
 needless_lifetimes = "allow"

crates/rapier_testbed3d/Cargo.toml

@@ -34,12 +34,12 @@ default = ["dim3"]
 dim3 = []
 parallel = ["rapier/parallel", "num_cpus"]
 other-backends = ["physx", "physx-sys", "glam"]
-profiling = ["dep:puffin_egui", "profiling/profile-with-puffin"]
+profiler_ui = ["dep:puffin_egui", "profiling/profile-with-puffin"]
 # See https://github.com/dimforge/rapier/issues/760.
 unstable-puffin-pr-235 = []
 
 [package.metadata.docs.rs]
-features = ["parallel", "other-backends", "profiling"]
+features = ["parallel", "other-backends", "profiler_ui"]
 
 [lints.clippy]
 needless_lifetimes = "allow"

examples2d/Cargo.toml

@@ -20,7 +20,7 @@ usvg = "0.14"
 
 [dependencies.rapier_testbed2d]
 path = "../crates/rapier_testbed2d"
-features = ["profiling"]
+features = ["profiler_ui"]
 
 [dependencies.rapier2d]
 path = "../crates/rapier2d"

examples2d/all_examples2.rs

@@ -16,6 +16,7 @@ mod convex_polygons2;
 mod damping2;
 mod debug_box_ball2;
 mod debug_compression2;
+mod debug_intersection2;
 mod debug_total_overlap2;
 mod debug_vertical_column2;
 mod drum2;
@@ -99,6 +100,7 @@ pub fn main() {
         ("Joint motor position", joint_motor_position2::init_world),
         ("(Debug) box ball", debug_box_ball2::init_world),
         ("(Debug) compression", debug_compression2::init_world),
+        ("(Debug) intersection", debug_intersection2::init_world),
         ("(Debug) total overlap", debug_total_overlap2::init_world),
         (
             "(Debug) vertical column",

examples2d/debug_intersection2.rs

@@ -0,0 +1,66 @@
+use rapier2d::prelude::*;
+use rapier_testbed2d::Testbed;
+
+pub fn init_world(testbed: &mut Testbed) {
+    /*
+     * World
+     */
+    let mut bodies = RigidBodySet::new();
+    let mut colliders = ColliderSet::new();
+    let impulse_joints = ImpulseJointSet::new();
+    let multibody_joints = MultibodyJointSet::new();
+
+    let rad = 1.0;
+    let collider = ColliderBuilder::ball(rad);
+
+    let count = 100;
+    for x in 0..count {
+        for y in 0..count {
+            let rigid_body = RigidBodyBuilder::fixed().translation(vector![
+                (x as f32 - count as f32 / 2.0) * rad * 3.0,
+                (y as f32 - count as f32 / 2.0) * rad * 3.0
+            ]);
+            let handle = bodies.insert(rigid_body);
+            colliders.insert_with_parent(collider.clone(), handle, &mut bodies);
+            testbed.set_initial_body_color(
+                handle,
+                [
+                    x as f32 / count as f32,
+                    (count - y) as f32 / count as f32,
+                    0.5,
+                ],
+            );
+        }
+    }
+
+    /*
+     * Set up the testbed.
+     */
+    testbed.set_world(bodies, colliders, impulse_joints, multibody_joints);
+    testbed.look_at(point![0.0, 0.0], 50.0);
+
+    testbed.add_callback(move |graphics, physics, _, run| {
+        let slow_time = run.timestep_id as f32 / 3.0;
+        let intersection = physics.query_pipeline.intersection_with_shape(
+            &physics.bodies,
+            &physics.colliders,
+            &Isometry::translation(slow_time.cos() * 10.0, slow_time.sin() * 10.0),
+            &Ball::new(rad / 2.0),
+            QueryFilter::default(),
+        );
+
+        if let Some(graphics) = graphics {
+            for (handle, _) in physics.bodies.iter() {
+                graphics.set_body_color(handle, [0.5, 0.5, 0.5]);
+            }
+            if let Some(intersection) = intersection {
+                let collider = physics.colliders.get(intersection).unwrap();
+                let body_handle = collider.parent().unwrap();
+
+                graphics.set_body_color(body_handle, [1.0, 0.0, 0.0]);
+            }
+        }
+
+        //println!("intersection: {:?}", intersection);
+    });
+}

examples2d/trimesh2.rs

@@ -85,6 +85,7 @@ pub fn init_world(testbed: &mut Testbed) {
 
                 for k in 0..5 {
                     let collider = ColliderBuilder::trimesh(vertices.clone(), indices.clone())
+                        .unwrap()
                         .contact_skin(0.2);
                     let rigid_body = RigidBodyBuilder::dynamic()
                         .translation(vector![ith as f32 * 8.0 - 20.0, 20.0 + k as f32 * 11.0])

examples3d/Cargo.toml

@@ -23,7 +23,7 @@ bincode = "1"
 
 [dependencies.rapier_testbed3d]
 path = "../crates/rapier_testbed3d"
-features = ["profiling"]
+features = ["profiler_ui"]
 
 [dependencies.rapier3d]
 path = "../crates/rapier3d"

examples3d/debug_trimesh3.rs

@@ -48,7 +48,7 @@ pub fn init_world(testbed: &mut Testbed) {
 
     let rigid_body = RigidBodyBuilder::fixed().translation(vector![0.0, 0.0, 0.0]);
     let handle = bodies.insert(rigid_body);
-    let collider = ColliderBuilder::trimesh(vtx, idx);
+    let collider = ColliderBuilder::trimesh(vtx, idx).expect("Could not create trimesh collider.");
     colliders.insert_with_parent(collider, handle, &mut bodies);
     testbed.set_initial_body_color(handle, [0.3, 0.3, 0.3]);
 

examples3d/dynamic_trimesh3.rs

@@ -93,6 +93,7 @@ pub fn do_init_world(testbed: &mut Testbed, use_convex_decomposition: bool) {
             } else {
                 // SharedShape::trimesh(vertices, indices)
                 SharedShape::trimesh_with_flags(vertices, indices, TriMeshFlags::FIX_INTERNAL_EDGES)
+                    .unwrap()
             };
             shapes.push(decomposed_shape);
 

examples3d/trimesh3.rs

@@ -42,7 +42,8 @@ pub fn init_world(testbed: &mut Testbed) {
         vertices,
         indices,
         TriMeshFlags::MERGE_DUPLICATE_VERTICES,
-    );
+    )
+    .unwrap();
     colliders.insert_with_parent(collider, handle, &mut bodies);
 
     /*

src/geometry/collider.rs

@@ -10,7 +10,7 @@ use crate::pipeline::{ActiveEvents, ActiveHooks};
 use crate::prelude::ColliderEnabled;
 use na::Unit;
 use parry::bounding_volume::{Aabb, BoundingVolume};
-use parry::shape::{Shape, TriMeshFlags};
+use parry::shape::{Shape, TriMeshBuilderError, TriMeshFlags};
 
 #[cfg(feature = "dim3")]
 use crate::geometry::HeightFieldFlags;
@@ -685,8 +685,11 @@ impl ColliderBuilder {
     }
 
     /// Initializes a collider builder with a triangle mesh shape defined by its vertex and index buffers.
-    pub fn trimesh(vertices: Vec<Point<Real>>, indices: Vec<[u32; 3]>) -> Self {
-        Self::new(SharedShape::trimesh(vertices, indices))
+    pub fn trimesh(
+        vertices: Vec<Point<Real>>,
+        indices: Vec<[u32; 3]>,
+    ) -> Result<Self, TriMeshBuilderError> {
+        Ok(Self::new(SharedShape::trimesh(vertices, indices)?))
     }
 
     /// Initializes a collider builder with a triangle mesh shape defined by its vertex and index buffers and
@@ -695,8 +698,10 @@ impl ColliderBuilder {
         vertices: Vec<Point<Real>>,
         indices: Vec<[u32; 3]>,
         flags: TriMeshFlags,
-    ) -> Self {
-        Self::new(SharedShape::trimesh_with_flags(vertices, indices, flags))
+    ) -> Result<Self, TriMeshBuilderError> {
+        Ok(Self::new(SharedShape::trimesh_with_flags(
+            vertices, indices, flags,
+        )?))
     }
 
     /// Initializes a collider builder with a shape converted from the given triangle mesh index

src/geometry/mesh_converter.rs

@@ -1,6 +1,6 @@
 use parry::bounding_volume;
 use parry::math::{Isometry, Point, Real};
-use parry::shape::{Cuboid, SharedShape, TriMeshFlags};
+use parry::shape::{Cuboid, SharedShape, TriMeshBuilderError, TriMeshFlags};
 
 #[cfg(feature = "dim3")]
 use parry::transformation::vhacd::VHACDParameters;
@@ -17,6 +17,9 @@ pub enum MeshConverterError {
     /// The convex hull calculation carried out by the [`MeshConverter::ConvexHull`] failed.
     #[error("convex-hull computation failed")]
     ConvexHullFailed,
+    /// The TriMesh building failed.
+    #[error("TriMesh building failed")]
+    TriMeshBuilderError(TriMeshBuilderError),
 }
 
 /// Determines how meshes (generally when loaded from a file) are converted into Rapier colliders.
@@ -61,9 +64,11 @@ impl MeshConverter {
     ) -> Result<(SharedShape, Isometry<Real>), MeshConverterError> {
         let mut transform = Isometry::identity();
         let shape = match self {
-            MeshConverter::TriMesh => SharedShape::trimesh(vertices, indices),
+            MeshConverter::TriMesh => SharedShape::trimesh(vertices, indices)
+                .map_err(MeshConverterError::TriMeshBuilderError)?,
             MeshConverter::TriMeshWithFlags(flags) => {
                 SharedShape::trimesh_with_flags(vertices, indices, *flags)
+                    .map_err(MeshConverterError::TriMeshBuilderError)?
             }
             MeshConverter::Obb => {
                 let (pose, cuboid) = parry::utils::obb(&vertices);

src/pipeline/query_pipeline/mod.rs

@@ -480,20 +480,17 @@ impl QueryPipeline {
         filter: QueryFilter,
     ) -> Option<ColliderHandle> {
         let pipeline_shape = self.as_composite_shape(bodies, colliders, filter);
-        #[allow(deprecated)]
         // TODO: replace this with IntersectionCompositeShapeShapeVisitor when it
         //        can return the shape part id.
-        let mut visitor =
-            parry::query::details::IntersectionCompositeShapeShapeBestFirstVisitor::new(
-                &*self.query_dispatcher,
-                shape_pos,
-                &pipeline_shape,
-                shape,
-            );
+        let mut visitor = parry::query::details::IntersectionCompositeShapeShapeVisitor::new(
+            &*self.query_dispatcher,
+            shape_pos,
+            &pipeline_shape,
+            shape,
+        );
 
-        self.qbvh
-            .traverse_best_first(&mut visitor)
-            .map(|h| (h.1 .0))
+        self.qbvh.traverse_depth_first(&mut visitor);
+        visitor.found_intersection
     }
 
     /// Find the projection of a point on the closest collider.

src_testbed/testbed.rs

@@ -249,7 +249,7 @@ impl TestbedApp {
     }
 
     pub fn run_with_init(mut self, mut init: impl FnMut(&mut App)) {
-        #[cfg(feature = "profiling")]
+        #[cfg(feature = "profiler_ui")]
         puffin_egui::puffin::set_scopes_on(true);
 
         let mut args = env::args();

src_testbed/ui.rs

@@ -21,7 +21,7 @@ pub fn update_ui(
     harness: &mut Harness,
     debug_render: &mut DebugRenderPipelineResource,
 ) {
-    #[cfg(feature = "profiling")]
+    #[cfg(feature = "profiler_ui")]
     {
         let window = egui::Window::new("Profiling");
         let window = window.default_open(false);