/// <summary>
/// Does not mutate this object.
/// </summary>
internal Dictionary <int, Vector> CalcActualDisplacements(Vector lagranges, Vector cornerDisplacements,
Dictionary <int, Vector> fr)
{
var freeDisplacements = new Dictionary <int, Vector>();
foreach (int s in subdomains.Keys)
{
IFetiDPSubdomainMatrixManager matrices = matrixManagers[s];
// ur[s] = inv(Krr[s]) * (fr[s] - Br[s]^T * lagranges - Krc[s] * Lc[s] * uc)
Vector BrLambda = lagrangeEnumerator.BooleanMatrices[s].Multiply(lagranges, true);
Vector KrcLcUc = dofSeparator.CornerBooleanMatrices[s].Multiply(cornerDisplacements);
KrcLcUc = matrices.MultiplyKrcTimes(KrcLcUc);
Vector temp = fr[s].Copy();
temp.SubtractIntoThis(BrLambda);
temp.SubtractIntoThis(KrcLcUc);
Vector ur = matrices.MultiplyInverseKrrTimes(temp);
// uf[s] = union(ur[s], ubc[s])
// Remainder dofs
var uf = Vector.CreateZero(subdomains[s].FreeDofOrdering.NumFreeDofs);
int[] remainderDofs = dofSeparator.RemainderDofIndices[s];
uf.CopyNonContiguouslyFrom(remainderDofs, ur);
// Corner dofs: ubc[s] = Bc[s] * uc
Vector ubc = dofSeparator.CornerBooleanMatrices[s].Multiply(cornerDisplacements);
int[] cornerDofs = dofSeparator.CornerDofIndices[s];
uf.CopyNonContiguouslyFrom(cornerDofs, ubc);
freeDisplacements[s] = uf;
}
return(freeDisplacements);
}
public Vector MultiplyFIrc(Vector vector)
{
Preconditions.CheckMultiplicationDimensions(numCornerDofs, vector.Length);
// FIrc[s] * x = sum_over_s( Br[s] * (inv(Krr[s]) * (Krc[s] * (Lc[s] * x))) )
var result = Vector.CreateZero(Order);
foreach (int s in Br.Keys)
{
IFetiDPSubdomainMatrixManager matrices = matrixManagers[s];
Vector temp = Lc[s].Multiply(vector);
temp = matrices.MultiplyKrcTimes(temp);
temp = matrices.MultiplyInverseKrrTimes(temp);
temp = Br[s].Multiply(temp);
result.AddIntoThis(temp);
}
return(result);
}