From 97157c9423f3360c5e941b4065377689221014ae Mon Sep 17 00:00:00 2001
From: Crozet Sébastien <developer@crozet.re>
Date: Fri, 26 Mar 2021 18:16:27 +0100
Subject: First working version of non-linear CCD based on single-substep
 motion-clamping.

---
 src/data/coarena.rs | 14 ++++++++++++++
 1 file changed, 14 insertions(+)

(limited to 'src/data')

diff --git a/src/data/coarena.rs b/src/data/coarena.rs
index 78cbfa7..c25cc55 100644
--- a/src/data/coarena.rs
+++ b/src/data/coarena.rs
@@ -29,6 +29,20 @@ impl<T> Coarena<T> {
             .and_then(|(gg, t)| if g == *gg { Some(t) } else { None })
     }
 
+    /// Inserts an element into this coarena.
+    pub fn insert(&mut self, a: Index, value: T)
+    where
+        T: Clone + Default,
+    {
+        let (i1, g1) = a.into_raw_parts();
+
+        if self.data.len() <= i1 {
+            self.data.resize(i1 + 1, (u32::MAX as u64, T::default()));
+        }
+
+        self.data[i1] = (g1, value);
+    }
+
     /// Ensure that elements at the two given indices exist in this coarena, and return their reference.
     ///
     /// Missing elements are created automatically and initialized with the `default` value.
-- 
cgit