Pont3D szorzasMatrixPonttal(Pont3D be, Mat4x4 m)
{
Pont3D ki = new Pont3D(0, 0, 0);
ki.setX(be.getX() * m.M[0, 0] + be.getY() * m.M[1, 0] + be.getZ() * m.M[2, 0] + m.M[3, 0]);
ki.setY(be.getX() * m.M[0, 1] + be.getY() * m.M[1, 1] + be.getZ() * m.M[2, 1] + m.M[3, 1]);
ki.setZ(be.getX() * m.M[0, 2] + be.getY() * m.M[1, 2] + be.getZ() * m.M[2, 2] + m.M[3, 2]);
float w = be.getX() * m.M[0, 3] + be.getY() * m.M[1, 3] + be.getZ() * m.M[2, 3] + m.M[3, 3];
//if (w != 0)
//{
// ki.setX(ki.getX() / w);
// ki.setY(ki.getY() / w);
// ki.setZ(ki.getZ() / w);
//}
return(ki);
}
public override string ToString()
{
return("pont1 : " + p1.getX() + "x\t" + p1.getY() + "y\t" + p1.getZ() + "z\n" +
"pont2 : " + p2.getX() + "x\t" + p2.getY() + "y\t" + p2.getZ() + "z\n" +
"pont3 : " + p3.getX() + "x\t" + p3.getY() + "y\t" + p3.getZ() + "z");
}