/// <summary>
/// Transform
/// </summary>
/// <param name="r"></param>
/// <param name="origin"></param>
/// <param name="point"></param>
/// <returns></returns>
public Point3dModel Transform(double r, Point3dModel origin, Point3dModel point)
{
List <double> arraTranform1 = new List <double> {
1, 0, 0, -origin.X,
0, 1, 0, -origin.Y,
0, 0, 1, -origin.Z,
0, 0, 0, 1
};
Matrix3dModel T1 = new Matrix3dModel(arraTranform1);
List <double> rotationMatrix = new List <double> {
Math.Cos(r), -Math.Sin(r), 0, 0,
Math.Sin(r), Math.Cos(r), 0, 0,
0, 0, 1, 0,
0, 0, 0, 1
};
Matrix3dModel T2 = new Matrix3dModel(rotationMatrix);
List <double> arraTranform2 = new List <double> {
1, 0, 0, origin.X,
0, 1, 0, origin.Y,
0, 0, 1, origin.Z,
0, 0, 0, 1
};
Matrix3dModel T3 = new Matrix3dModel(arraTranform2);
Point3dModel tfBack = T1.Transform(point);
Point3dModel tfRotate = T2.Transform(tfBack);
Point3dModel tfMove = T3.Transform(tfRotate);
Point3dModel tfBlockTransform = this.Transform(tfMove);
return(tfBlockTransform);
}
/// <summary>
/// Transform with rotation, this means it is already tranformed back to
/// </summary>
/// <param name="r"></param>
/// <param name="point"></param>
/// <returns></returns>
public Point3dModel Transform(double r, Point3dModel point)
{
List <double> rotationMatrix = new List <double> {
Math.Cos(r), -Math.Sin(r), 0, 0,
Math.Sin(r), Math.Cos(r), 0, 0,
0, 0, 1, 0,
0, 0, 0, 1
};
Matrix3dModel T1 = new Matrix3dModel(rotationMatrix);
return(this.Transform(T1.Transform(point)));
}