public override void Merge(ObiActor actor, IObiConstraintsBatch other)
{
var batch = other as ObiShapeMatchingConstraintsBatch;
var user = actor as IShapeMatchingConstraintsUser;
if (batch != null && user != null)
{
if (!user.shapeMatchingConstraintsEnabled)
{
return;
}
int initialIndexCount = particleIndices.count;
// shape matching constraint particle indices are not reordered when deactivating constraints,
// so instead of using batch.activeConstraintCount, batch.constraintCount. We need all of them.
int numActiveIndices = 0;
for (int i = 0; i < batch.constraintCount; ++i)
{
numActiveIndices += batch.numIndices[i];
}
particleIndices.ResizeUninitialized(initialIndexCount + numActiveIndices);
firstIndex.ResizeUninitialized(m_ActiveConstraintCount + batch.activeConstraintCount);
numIndices.ResizeUninitialized(m_ActiveConstraintCount + batch.activeConstraintCount);
explicitGroup.ResizeUninitialized(m_ActiveConstraintCount + batch.activeConstraintCount);
materialParameters.ResizeUninitialized((m_ActiveConstraintCount + batch.activeConstraintCount) * 5);
restComs.ResizeUninitialized(m_ActiveConstraintCount + batch.activeConstraintCount);
coms.ResizeUninitialized(m_ActiveConstraintCount + batch.activeConstraintCount);
orientations.ResizeUninitialized(m_ActiveConstraintCount + batch.activeConstraintCount);
lambdas.ResizeInitialized(m_ActiveConstraintCount + batch.activeConstraintCount);
numIndices.CopyFrom(batch.numIndices, 0, m_ActiveConstraintCount, batch.activeConstraintCount);
explicitGroup.CopyFrom(batch.explicitGroup, 0, m_ActiveConstraintCount, batch.activeConstraintCount);
orientations.CopyReplicate(actor.actorLocalToSolverMatrix.rotation, m_ActiveConstraintCount, batch.activeConstraintCount);
for (int i = 0; i < numActiveIndices; ++i)
{
particleIndices[initialIndexCount + i] = actor.solverIndices[batch.particleIndices[i]];
}
for (int i = 0; i < batch.activeConstraintCount; ++i)
{
firstIndex[m_ActiveConstraintCount + i] = batch.firstIndex[i] + initialIndexCount;
materialParameters[(m_ActiveConstraintCount + i) * 5] = user.deformationResistance;
materialParameters[(m_ActiveConstraintCount + i) * 5 + 1] = user.plasticYield;
materialParameters[(m_ActiveConstraintCount + i) * 5 + 2] = user.plasticCreep;
materialParameters[(m_ActiveConstraintCount + i) * 5 + 3] = user.plasticRecovery;
materialParameters[(m_ActiveConstraintCount + i) * 5 + 4] = user.maxDeformation;
}
base.Merge(actor, other);
}
}
