/// <summary>
/// not implemented
/// </summary>
/// <param name="writer"></param>
public void WriteXml(XmlWriter writer)
{
writer.WriteName("transform");
var s = WorldMat.ToXMLValueString();
writer.WriteValue(s);
writer.WriteEndElement();
}
public Cube(Node[] nodes, WorldMat mat)
{
this.nodes = nodes;
this.mat = mat;
// Compute the cubePos using the nodes and use this to compute the cost of the cube
pos = new Vector3();
for (int i = 0; i < nodes.Length; i++)
{
pos += nodes[i].pos;
}
pos /= nodes.Length;
ComputeCube();
}
public void updateFromCeres(CeresPointOrient paramblock)
{
var rot3d = new RotationVector3D(paramblock.R_rod);
var mat3 = new Matrix <double>(3, 3, rot3d.RotationMatrix.DataPointer);
for (int r = 0; r < 3; r++)
{
for (int c = 0; c < 3; c++)
{
RotationMat[r, c] = mat3[r, c];
}
}
setPos(paramblock.t);
WorldMat = WorldMat.Inverted();
OnPropertyChanged();
}