From 0e4393ba9e408952395cfccaef6dc192886e2839 Mon Sep 17 00:00:00 2001
From: Crozet Sébastien <developer@crozet.re>
Date: Sun, 7 Mar 2021 17:15:32 +0100
Subject: Reduce code duplication between the SIMD and non-SIMD contact solve
 and warmstart.

---
 src/dynamics/solver/delta_vel.rs | 8 ++++++++
 1 file changed, 8 insertions(+)

(limited to 'src/dynamics/solver/delta_vel.rs')

diff --git a/src/dynamics/solver/delta_vel.rs b/src/dynamics/solver/delta_vel.rs
index 378d302..b50cb76 100644
--- a/src/dynamics/solver/delta_vel.rs
+++ b/src/dynamics/solver/delta_vel.rs
@@ -1,5 +1,6 @@
 use crate::math::{AngVector, Vector};
 use na::{Scalar, SimdRealField};
+use std::ops::AddAssign;
 
 #[derive(Copy, Clone, Debug)]
 //#[repr(align(64))]
@@ -16,3 +17,10 @@ impl<N: SimdRealField> DeltaVel<N> {
         }
     }
 }
+
+impl<N: SimdRealField> AddAssign for DeltaVel<N> {
+    fn add_assign(&mut self, rhs: Self) {
+        self.linear += rhs.linear;
+        self.angular += rhs.angular;
+    }
+}
-- 
cgit