From ce26fe107727ee4ef25ee728b3bb3a40914fdc99 Mon Sep 17 00:00:00 2001 From: Sébastien Crozet Date: Mon, 31 Aug 2020 19:03:56 +0200 Subject: Add compound demo. --- src_testbed/nphysics_backend.rs | 4 ++-- src_testbed/physx_backend.rs | 4 ++-- 2 files changed, 4 insertions(+), 4 deletions(-) (limited to 'src_testbed') diff --git a/src_testbed/nphysics_backend.rs b/src_testbed/nphysics_backend.rs index 43f3bf9..a2a9bfc 100644 --- a/src_testbed/nphysics_backend.rs +++ b/src_testbed/nphysics_backend.rs @@ -176,7 +176,7 @@ fn nphysics_collider_from_rapier_collider( is_dynamic: bool, ) -> Option> { let margin = ColliderDesc::::default_margin(); - let mut pos = Isometry::identity(); + let mut pos = *collider.position_wrt_parent(); let shape = match collider.shape() { Shape::Cuboid(cuboid) => { @@ -184,7 +184,7 @@ fn nphysics_collider_from_rapier_collider( } Shape::Ball(ball) => ShapeHandle::new(Ball::new(ball.radius - margin)), Shape::Capsule(capsule) => { - pos = capsule.transform_wrt_y(); + pos *= capsule.transform_wrt_y(); ShapeHandle::new(Capsule::new(capsule.half_height(), capsule.radius)) } Shape::HeightField(heightfield) => ShapeHandle::new(heightfield.clone()), diff --git a/src_testbed/physx_backend.rs b/src_testbed/physx_backend.rs index 9ae7bb8..045e697 100644 --- a/src_testbed/physx_backend.rs +++ b/src_testbed/physx_backend.rs @@ -399,7 +399,7 @@ impl PhysxWorld { fn physx_collider_from_rapier_collider( collider: &Collider, ) -> Option<(ColliderDesc, Isometry3)> { - let mut local_pose = Isometry3::identity(); + let mut local_pose = *collider.position_wrt_parent(); let desc = match collider.shape() { Shape::Cuboid(cuboid) => ColliderDesc::Box( cuboid.half_extents.x, @@ -416,7 +416,7 @@ fn physx_collider_from_rapier_collider( } let rot = UnitQuaternion::rotation_between(&Vector3::x(), &dir); - local_pose = + local_pose *= Translation3::from(center.coords) * rot.unwrap_or(UnitQuaternion::identity()); ColliderDesc::Capsule(capsule.radius, capsule.height()) } -- cgit From 9622827dc6aadb391512b95381edb1efc26b1b90 Mon Sep 17 00:00:00 2001 From: Sébastien Crozet Date: Tue, 1 Sep 2020 14:02:59 +0200 Subject: Fix constraints resolution with non-identity relative collider position. --- src_testbed/nphysics_backend.rs | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) (limited to 'src_testbed') diff --git a/src_testbed/nphysics_backend.rs b/src_testbed/nphysics_backend.rs index a2a9bfc..f66d987 100644 --- a/src_testbed/nphysics_backend.rs +++ b/src_testbed/nphysics_backend.rs @@ -13,7 +13,7 @@ use rapier::dynamics::{ IntegrationParameters, JointParams, JointSet, RigidBodyHandle, RigidBodySet, }; use rapier::geometry::{Collider, ColliderSet, Shape}; -use rapier::math::{Isometry, Vector}; +use rapier::math::Vector; use std::collections::HashMap; #[cfg(feature = "dim3")] use {ncollide::shape::TriMesh, nphysics::joint::BallConstraint}; -- cgit From 2f2a073ce47eaa17f44d88b9dc6cc56362c374e2 Mon Sep 17 00:00:00 2001 From: Sébastien Crozet Date: Tue, 1 Sep 2020 17:05:24 +0200 Subject: Fix mass property update when adding a collider. --- src_testbed/nphysics_backend.rs | 2 +- src_testbed/physx_backend.rs | 24 +++++++++++++++++++++++- src_testbed/testbed.rs | 31 +++++++++++++++++++++++++++---- 3 files changed, 51 insertions(+), 6 deletions(-) (limited to 'src_testbed') diff --git a/src_testbed/nphysics_backend.rs b/src_testbed/nphysics_backend.rs index f66d987..c9ff2d1 100644 --- a/src_testbed/nphysics_backend.rs +++ b/src_testbed/nphysics_backend.rs @@ -165,7 +165,7 @@ impl NPhysicsWorld { for coll_handle in rb.colliders() { let collider = &mut colliders[*coll_handle]; - collider.set_position_debug(pos * collider.delta()); + collider.set_position_debug(pos * collider.position_wrt_parent()); } } } diff --git a/src_testbed/physx_backend.rs b/src_testbed/physx_backend.rs index 045e697..66036c8 100644 --- a/src_testbed/physx_backend.rs +++ b/src_testbed/physx_backend.rs @@ -225,6 +225,28 @@ impl PhysxWorld { } } + // Update mass properties. + for (rapier_handle, physx_handle) in rapier2physx.iter() { + let rb = &bodies[*rapier_handle]; + if let Some(mut ra) = scene.get_dynamic_mut(*physx_handle) { + let densities: Vec<_> = rb + .colliders() + .iter() + .map(|h| colliders[*h].density()) + .collect(); + + unsafe { + physx_sys::PxRigidBodyExt_updateMassAndInertia_mut( + ra.as_ptr_mut().ptr as *mut physx_sys::PxRigidBody, + densities.as_ptr(), + densities.len() as u32, + std::ptr::null(), + false, + ); + } + } + } + let mut res = Self { physics, cooking, @@ -390,7 +412,7 @@ impl PhysxWorld { for coll_handle in rb.colliders() { let collider = &mut colliders[*coll_handle]; - collider.set_position_debug(iso * collider.delta()); + collider.set_position_debug(iso * collider.position_wrt_parent()); } } } diff --git a/src_testbed/testbed.rs b/src_testbed/testbed.rs index 868bd91..450170e 100644 --- a/src_testbed/testbed.rs +++ b/src_testbed/testbed.rs @@ -791,6 +791,29 @@ impl Testbed { .state .action_flags .set(TestbedActionFlags::EXAMPLE_CHANGED, true), + WindowEvent::Key(Key::C, Action::Release, _) => { + // Delete 1 collider of 10% of the remaining dynamic bodies. + let mut colliders: Vec<_> = self + .physics + .bodies + .iter() + .filter(|e| e.1.is_dynamic()) + .filter(|e| !e.1.colliders().is_empty()) + .map(|e| e.1.colliders().to_vec()) + .collect(); + colliders.sort_by_key(|co| -(co.len() as isize)); + + let num_to_delete = (colliders.len() / 10).max(1); + for to_delete in &colliders[..num_to_delete] { + self.physics.pipeline.remove_collider( + to_delete[0], + &mut self.physics.broad_phase, + &mut self.physics.narrow_phase, + &mut self.physics.bodies, + &mut self.physics.colliders, + ); + } + } WindowEvent::Key(Key::D, Action::Release, _) => { // Delete 10% of the remaining dynamic bodies. let dynamic_bodies: Vec<_> = self @@ -1539,7 +1562,7 @@ impl State for Testbed { } if self.state.flags.contains(TestbedStateFlags::CONTACT_POINTS) { - draw_contacts(window, &self.physics.narrow_phase, &self.physics.bodies); + draw_contacts(window, &self.physics.narrow_phase, &self.physics.colliders); } if self.state.running == RunMode::Step { @@ -1634,7 +1657,7 @@ Hashes at frame: {} } } -fn draw_contacts(window: &mut Window, nf: &NarrowPhase, bodies: &RigidBodySet) { +fn draw_contacts(window: &mut Window, nf: &NarrowPhase, colliders: &ColliderSet) { for (_, _, pair) in nf.contact_graph().interaction_pairs() { for manifold in &pair.manifolds { for pt in manifold.all_contacts() { @@ -1643,8 +1666,8 @@ fn draw_contacts(window: &mut Window, nf: &NarrowPhase, bodies: &RigidBodySet) { } else { Point3::new(1.0, 0.0, 0.0) }; - let pos1 = bodies[manifold.body_pair.body1].position; - let pos2 = bodies[manifold.body_pair.body2].position; + let pos1 = colliders[manifold.pair.collider1].position(); + let pos2 = colliders[manifold.pair.collider2].position(); let start = pos1 * pt.local_p1; let end = pos2 * pt.local_p2; let n = pos1 * manifold.local_n1; -- cgit From fc0b3bf39484029d956055943b38bb55ab2c5791 Mon Sep 17 00:00:00 2001 From: Sébastien Crozet Date: Tue, 1 Sep 2020 17:35:32 +0200 Subject: Mass properties: add a max number of iterations for the local-frame rotation computation. --- src_testbed/physx_backend.rs | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) (limited to 'src_testbed') diff --git a/src_testbed/physx_backend.rs b/src_testbed/physx_backend.rs index 66036c8..b06fd7e 100644 --- a/src_testbed/physx_backend.rs +++ b/src_testbed/physx_backend.rs @@ -228,7 +228,7 @@ impl PhysxWorld { // Update mass properties. for (rapier_handle, physx_handle) in rapier2physx.iter() { let rb = &bodies[*rapier_handle]; - if let Some(mut ra) = scene.get_dynamic_mut(*physx_handle) { + if let Some(rp) = scene.get_dynamic_mut(*physx_handle) { let densities: Vec<_> = rb .colliders() .iter() @@ -237,7 +237,7 @@ impl PhysxWorld { unsafe { physx_sys::PxRigidBodyExt_updateMassAndInertia_mut( - ra.as_ptr_mut().ptr as *mut physx_sys::PxRigidBody, + rp.as_ptr_mut().ptr as *mut physx_sys::PxRigidBody, densities.as_ptr(), densities.len() as u32, std::ptr::null(), -- cgit