public override Matrix3x3 ComputeVolumeDistribution()
{
var volumeDistribution = new Matrix3x3();
float totalWeight = 0;
for (int i = 0; i < shapes.Count; i++)
{
totalWeight += shapes.Elements[i].Weight;
Matrix3x3 contribution;
GetContribution(shapes.Elements[i].Shape, ref shapes.Elements[i].LocalTransform, ref Toolbox.ZeroVector, shapes.Elements[i].Weight, out contribution);
Matrix3x3.Add(ref contribution, ref volumeDistribution, out volumeDistribution);
}
Matrix3x3.Multiply(ref volumeDistribution, 1 / totalWeight, out volumeDistribution);
return volumeDistribution;
}