Make cloning rigid-bodies and colliders more idiomatic.

Fix #53

src/dynamics/joint/joint.rs

@@ -95,6 +95,7 @@ impl From<PrismaticJoint> for JointParams {
 }
 
 #[cfg_attr(feature = "serde-serialize", derive(Serialize, Deserialize))]
+#[derive(Clone)]
 /// A joint attached to two bodies.
 pub struct Joint {
     /// Handle to the first body attached to this joint.

src/dynamics/rigid_body.rs

@@ -27,7 +27,7 @@ pub enum BodyStatus {
 /// A rigid body.
 ///
 /// To create a new rigid-body, use the `RigidBodyBuilder` structure.
-#[derive(Debug)]
+#[derive(Debug, Clone)]
 pub struct RigidBody {
     /// The world-space position of the rigid-body.
     pub position: Isometry<f32>,
@@ -58,20 +58,6 @@ pub struct RigidBody {
     pub user_data: u128,
 }
 
-impl Clone for RigidBody {
-    fn clone(&self) -> Self {
-        Self {
-            colliders: Vec::new(),
-            joint_graph_index: RigidBodyGraphIndex::new(crate::INVALID_U32),
-            active_island_id: crate::INVALID_USIZE,
-            active_set_id: crate::INVALID_USIZE,
-            active_set_offset: crate::INVALID_USIZE,
-            active_set_timestamp: crate::INVALID_U32,
-            ..*self
-        }
-    }
-}
-
 impl RigidBody {
     fn new() -> Self {
         Self {
@@ -96,6 +82,15 @@ impl RigidBody {
         }
     }
 
+    pub(crate) fn reset_internal_links(&mut self) {
+        self.colliders = Vec::new();
+        self.joint_graph_index = RigidBodyGraphIndex::new(crate::INVALID_U32);
+        self.active_island_id = crate::INVALID_USIZE;
+        self.active_set_id = crate::INVALID_USIZE;
+        self.active_set_offset = crate::INVALID_USIZE;
+        self.active_set_timestamp = crate::INVALID_U32;
+    }
+
     pub(crate) fn integrate_accelerations(&mut self, dt: f32, gravity: Vector<f32>) {
         if self.mass_properties.inv_mass != 0.0 {
             self.linvel += (gravity + self.linacc) * dt;

src/dynamics/rigid_body_set.rs

@@ -154,7 +154,11 @@ impl RigidBodySet {
     }
 
     /// Insert a rigid body into this set and retrieve its handle.
-    pub fn insert(&mut self, rb: RigidBody) -> RigidBodyHandle {
+    pub fn insert(&mut self, mut rb: RigidBody) -> RigidBodyHandle {
+        // Make sure the internal links are reset, they may not be
+        // if this rigid-body was obtained by cloning another one.
+        rb.reset_internal_links();
+
         let handle = self.bodies.insert(rb);
         let rb = &mut self.bodies[handle];