/**
* Method that calculates the coordinates with global position from local coordinates.
*/
public Vector3 CalculateGlobalPosition(Vector3 mLocalVector)
{
int numRows = 3;
int numColls = 1;
double[][] baseVector = MatrixInverseProgram.MatrixCreate(numRows, numColls);
baseVector[0][0] = mLocalVector.x;
baseVector[1][0] = mLocalVector.y;
baseVector[2][0] = mLocalVector.z;
double[][] transformedVector = MatrixInverseProgram.MatrixProduct(baseMatrix, baseVector);
Vector3 vectorTransformedCoordinates = new Vector3((float)transformedVector[0][0], (float)transformedVector[1][0], (float)transformedVector[2][0]);
return(vectorTransformedCoordinates + planeOrigin);
}
/**
* Method that returns the vector coordinate with reference to the local (plane) coordinates.
*/
public Vector3 CalculateCoordinateLocalBase(Vector3 mVector)
{
Vector3 inputVector = mVector - planeOrigin;
int numRows = 3;
int numColls = 1;
double[][] baseVector = MatrixInverseProgram.MatrixCreate(numRows, numColls);
baseVector[0][0] = inputVector.x;
baseVector[1][0] = inputVector.y;
baseVector[2][0] = inputVector.z;
double[][] transformedVector = MatrixInverseProgram.MatrixProduct(inverseMatrix, baseVector);
Vector3 vectorTransformedCoordinates = new Vector3((float)transformedVector[0][0], (float)transformedVector[1][0], (float)transformedVector[2][0]);
return(vectorTransformedCoordinates);
}
public void SetPlane(Vector3 firstVertexRight, Vector3 firstVertexLeft, Vector3 secondVertexRight,
Vector3 secondVertexLeft)
{
this.firstVertexRight = firstVertexRight;
this.firstVertexLeft = firstVertexLeft;
this.secondVertexRight = secondVertexRight;
this.secondVertexLeft = secondVertexLeft;
this.i = (secondVertexLeft - firstVertexLeft);
this.j = (firstVertexRight - firstVertexLeft);
this.k = Vector3.Cross(i, j).normalized;
this.planeOrigin = this.firstVertexLeft;
this.planeNormal = this.k;
baseMatrix = MatrixInverseProgram.MatrixCreate(3, 3);
baseMatrix[0][0] = i.x; baseMatrix[0][1] = j.x; baseMatrix[0][2] = k.x;
baseMatrix[1][0] = i.y; baseMatrix[1][1] = j.y; baseMatrix[1][2] = k.y;
baseMatrix[2][0] = i.z; baseMatrix[2][1] = j.z; baseMatrix[2][2] = k.z;
inverseMatrix = MatrixInverseProgram.MatrixInverse(baseMatrix);
}