fix bug caused by not reseting to zero

1 files changed, 13 insertions, 3 deletions

diff --git a/src/BulletSoftBody/btDeformableBodySolver.cpp b/src/BulletSoftBody/btDeformableBodySolver.cpp
index fc792bd7f..4dd45edc8 100644
--- a/src/BulletSoftBody/btDeformableBodySolver.cpp
+++ b/src/BulletSoftBody/btDeformableBodySolver.cpp
@@ -55,9 +55,19 @@ void btDeformableBodySolver::reinitialize(const btAlignedObjectArray<btSoftBody
     m_softBodySet.copyFromArray(softBodies);
     bool nodeUpdated = updateNodes();
     
-    m_dv.resize(m_numNodes, btVector3(0,0,0));
-    m_residual.resize(m_numNodes, btVector3(0,0,0));
-    m_backupVelocity.resize(m_numNodes, btVector3(0,0,0));
+    if (nodeUpdated)
+    {
+        m_dv.resize(m_numNodes, btVector3(0,0,0));
+        m_residual.resize(m_numNodes, btVector3(0,0,0));
+        m_backupVelocity.resize(m_numNodes, btVector3(0,0,0));
+    }
+    
+    // need to setZero here as resize only set value for newly allocated items
+    for (int i = 0; i < m_numNodes; ++i)
+    {
+        m_dv[i].setZero();
+        m_residual[i].setZero();
+    }
     
     m_objective->reinitialize(nodeUpdated);
 }