//private double AngleFix(double angle)
//{
// if (angle != 0 && angle%360 == 0) angle = 0;
// while (angle > 180)
// {
// angle -= 360;
// }
// while (angle < -180)
// {
// angle += 360;
// }
// return angle;
//}
public void Zoom(double dx, double dy, double dz, PointD point)
{
double[,] _zoomArray = new[,]
{
{dx - 1, 0, 0},
{0, dy - 1, 0},
{0, 0, dz - 1}
};
foreach (List<Line> lines in faces.Select(x => x.Lines))
{
foreach (Line line in lines)
{
line.Start = new PointD(
-(point.X - line.Start.X)*_zoomArray[0, 0] + line.Start.X,
-(point.Y - line.Start.Y)*_zoomArray[1, 1] + line.Start.Y,
-(point.Z - line.Start.Z)*_zoomArray[2, 2] + line.Start.Z);
line.End = new PointD(
-(point.X - line.End.X)*_zoomArray[0, 0] + line.End.X,
-(point.Y - line.End.Y)*_zoomArray[1, 1] + line.End.Y,
-(point.Z - line.End.Z)*_zoomArray[2, 2] + line.End.Z);
}
}
BasePoint = faces[0].Lines[0].Start;
}
public BaseModel(double x, double y, double z, double a, double b, double c, double d)
{
BasePoint = new PointD(x, y, z);
A = a;
B = b;
C = c;
D = d;
faces = new List<Face>
{
new Face // H left part
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x, y, z), new PointD(x + A, y, z)),
new Line(new PointD(x + A, y, z), new PointD(x + A, y + D, z)),
new Line(new PointD(x + A, y + D, z), new PointD(x, y + D, z)),
new Line(new PointD(x, y + D, z), new PointD(x, y, z)),
},
xAngleCurrent = 0,
yAngleCurrent = 90,
zAngleCurrent = 90
},
new Face // H center part
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x + A, y + ((D - A)/2), z),
new PointD(x + A + (B - 2*A), y + ((D - A)/2), z)),
new Line(new PointD(x + A + (B - 2*A), y + ((D - A)/2), z),
new PointD(x + A + (B - 2*A), y + ((D - A)/2) + A, z)),
new Line(new PointD(x + A + (B - 2*A), y + ((D - A)/2) + A, z),
new PointD(x + A, y + ((D - A)/2) + A, z)),
new Line(new PointD(x + A, y + ((D - A)/2) + A, z),
new PointD(x + A, y + ((D - A)/2), z)),
},
xAngleCurrent = 0,
yAngleCurrent = 90,
zAngleCurrent = 90
},
new Face // H right part
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x + B - A, y, z), new PointD(x + B, y, z)),
new Line(new PointD(x + B, y, z), new PointD(x + B, y + D, z)),
new Line(new PointD(x + B, y + D, z), new PointD(x + B - A, y + D, z)),
new Line(new PointD(x + B - A, y + D, z), new PointD(x + B - A, y, z)),
},
xAngleCurrent = 0,
yAngleCurrent = 90,
zAngleCurrent = 90
},
new Face
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x, y, z), new PointD(x, y, z - C)),
new Line(new PointD(x, y, z - C), new PointD(x + A, y, z - C)),
new Line(new PointD(x + A, y, z - C), new PointD(x + A, y, z)),
new Line(new PointD(x + A, y, z), new PointD(x, y, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 90,
zAngleCurrent = 0
},
new Face
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x + A, y, z), new PointD(x + A, y, z - C)),
new Line(new PointD(x + A, y, z - C), new PointD(x + A, y + (D - A)/2, z - C)),
new Line(new PointD(x + A, y + (D - A)/2, z - C),
new PointD(x + A, y + (D - A)/2, z)),
new Line(new PointD(x + A, y + (D - A)/2, z), new PointD(x + A, y, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 0,
zAngleCurrent = 90
},
new Face
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x + A, y + (D - A)/2, z),
new PointD(x + A, y + (D - A)/2, z - C)),
new Line(new PointD(x + A, y + (D - A)/2, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2, z - C)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2, z)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2, z),
new PointD(x + A, y + (D - A)/2, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 90,
zAngleCurrent = 0
},
new Face
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x + A + (B - 2*A), y, z),
new PointD(x + A + (B - 2*A), y, z - C)),
new Line(new PointD(x + A + (B - 2*A), y, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2, z - C)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2, z)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2, z),
new PointD(x + A + (B - 2*A), y, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 0,
zAngleCurrent = 90
},
new Face
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x + (B - A), y, z), new PointD(x + (B - A), y, z - C)),
new Line(new PointD(x + (B - A), y, z - C), new PointD(x + A + (B - A), y, z - C)),
new Line(new PointD(x + A + (B - A), y, z - C), new PointD(x + A + (B - A), y, z)),
new Line(new PointD(x + A + (B - A), y, z), new PointD(x + (B - A), y, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 90,
zAngleCurrent = 0
},
new Face
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x + B, y, z), new PointD(x + B, y, z - C)),
new Line(new PointD(x + B, y, z - C), new PointD(x + B, y + D, z - C)),
new Line(new PointD(x + B, y + D, z - C), new PointD(x + B, y + D, z)),
new Line(new PointD(x + B, y + D, z), new PointD(x + B, y, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 0,
zAngleCurrent = 90
},
new Face
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x + B - A, y + D, z), new PointD(x + B - A, y + D, z - C)),
new Line(new PointD(x + B - A, y + D, z - C), new PointD(x + B, y + D, z - C)),
new Line(new PointD(x + B, y + D, z - C), new PointD(x + B, y + D, z)),
new Line(new PointD(x + B, y + D, z), new PointD(x + B - A, y + D, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 90,
zAngleCurrent = 0
},
new Face
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x + A + (B - 2*A), y + (D + A)/2, z),
new PointD(x + A + (B - 2*A), y + (D + A)/2, z - C)),
new Line(new PointD(x + A + (B - 2*A), y + (D + A)/2, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2 + (D + A)/2, z - C)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2 + (D + A)/2, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2 + (D + A)/2, z)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2 + (D + A)/2, z),
new PointD(x + A + (B - 2*A), y + (D + A)/2, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 0,
zAngleCurrent = 90
},
new Face
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x + A, y + (D - A)/2 + A, z),
new PointD(x + A, y + (D - A)/2 + A, z - C)),
new Line(new PointD(x + A, y + (D - A)/2 + A, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2 + A, z - C)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2 + A, z - C),
new PointD(x + A + (B - 2*A), y + (D - A)/2 + A, z)),
new Line(new PointD(x + A + (B - 2*A), y + (D - A)/2 + A, z),
new PointD(x + A, y + (D - A)/2 + A, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 90,
zAngleCurrent = 0
},
new Face
{
IsFrontStart = true,
Lines = new List<Line>
{
new Line(new PointD(x + A, y + (D + A)/2, z),
new PointD(x + A, y + (D + A)/2, z - C)),
new Line(new PointD(x + A, y + (D + A)/2, z - C),
new PointD(x + A, y + (D - A)/2 + (D + A)/2, z - C)),
new Line(new PointD(x + A, y + (D - A)/2 + (D + A)/2, z - C),
new PointD(x + A, y + (D - A)/2 + (D + A)/2, z)),
new Line(new PointD(x + A, y + (D - A)/2 + (D + A)/2, z),
new PointD(x + A, y + (D + A)/2, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 0,
zAngleCurrent = 90
},
new Face
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x, y + D, z), new PointD(x, y + D, z - C)),
new Line(new PointD(x, y + D, z - C), new PointD(x + A, y + D, z - C)),
new Line(new PointD(x + A, y + D, z - C), new PointD(x + A, y + D, z)),
new Line(new PointD(x + A, y + D, z), new PointD(x, y + D, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 90,
zAngleCurrent = 0
},
new Face
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x, y, z), new PointD(x, y, z - C)),
new Line(new PointD(x, y, z - C), new PointD(x, y + D, z - C)),
new Line(new PointD(x, y + D, z - C), new PointD(x, y + D, z)),
new Line(new PointD(x, y + D, z), new PointD(x, y, z)),
},
xAngleCurrent = 90,
yAngleCurrent = 0,
zAngleCurrent = 90
},
new Face // H left part
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x, y, z - C), new PointD(x + A, y, z - C)),
new Line(new PointD(x + A, y, z - C), new PointD(x + A, y + D, z - C)),
new Line(new PointD(x + A, y + D, z - C), new PointD(x, y + D, z - C)),
new Line(new PointD(x, y + D, z - C), new PointD(x, y, z - C)),
},
xAngleCurrent = 0,
yAngleCurrent = 90,
zAngleCurrent = 90
},
new Face // H center part
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x + A, y + ((D - A)/2), z - C),
new PointD(x + A + (B - 2*A), y + ((D - A)/2), z - C)),
new Line(new PointD(x + A + (B - 2*A), y + ((D - A)/2), z - C),
new PointD(x + A + (B - 2*A), y + ((D - A)/2) + A, z - C)),
new Line(new PointD(x + A + (B - 2*A), y + ((D - A)/2) + A, z - C),
new PointD(x + A, y + ((D - A)/2) + A, z - C)),
new Line(new PointD(x + A, y + ((D - A)/2) + A, z - C),
new PointD(x + A, y + ((D - A)/2), z - C)),
},
xAngleCurrent = 0,
yAngleCurrent = 90,
zAngleCurrent = 90
},
new Face // H right part
{
IsFrontStart = false,
Lines = new List<Line>
{
new Line(new PointD(x + B - A, y, z - C), new PointD(x + B, y, z - C)),
new Line(new PointD(x + B, y, z - C), new PointD(x + B, y + D, z - C)),
new Line(new PointD(x + B, y + D, z - C), new PointD(x + B - A, y + D, z - C)),
new Line(new PointD(x + B - A, y + D, z - C), new PointD(x + B - A, y, z - C)),
},
xAngleCurrent = 0,
yAngleCurrent = 90,
zAngleCurrent = 90
},
};
foreach (Face face in faces)
{
face.xAngleStart = face.xAngleCurrent;
face.yAngleStart = face.yAngleCurrent;
face.zAngleStart = face.zAngleCurrent;
face.IsFrontCurrent = face.IsFrontStart;
}
}
public void Rotate(double alpha, double beta, double gamma, PointD point)
{
double xRad = (Math.PI/180)*alpha; //rad's
double yRad = (Math.PI/180)*beta; //rad's
double zRad = (Math.PI/180)*gamma; //rad's
double C1 = Math.Cos(xRad), C2 = Math.Cos(yRad), C3 = Math.Cos(zRad);
double S1 = Math.Sin(xRad), S2 = Math.Sin(yRad), S3 = Math.Sin(zRad);
double[][] _rotateArray = new[]
{
new[] {C2*C3, - C2*S3, S2, 0},
new[] {C1*S3 + C3*S1*S2, C1*C3 - S1*S2*S3, - C2*S1, 0},
new[] {S1*S3 - C1*C3*S2, C3*S1 + C1*S2*S3, C1*C2, 0},
new[] {0.0, 0, 0, 0}
};
double[][] _rotateArrayAlpha = new[]
{
new double[] {1, 0, 0, 0},
new[] {0, Math.Cos(xRad), Math.Sin(xRad), 0},
new[] {0, -Math.Sin(xRad), Math.Cos(xRad), 0},
new double[] {0, 0, 0, 1}
};
double[][] _rotateArrayBeta = new[]
{
new[] {Math.Cos(yRad), 0, -Math.Sin(yRad), 0},
new double[] {0, 1, 0, 0},
new[] {Math.Sin(yRad), 0, Math.Cos(yRad), 0},
new double[] {0, 0, 0, 1}
};
double[][] _rotateArrayGamma = new[]
{
new[] {Math.Cos(zRad), Math.Sin(zRad), 0, 0},
new[] {-Math.Sin(zRad), Math.Cos(zRad), 0, 0},
new double[] {0, 0, 1, 0},
new double[] {0, 0, 0, 1}
};
foreach (Face face in faces)
{
List<Line> lines = face.Lines;
foreach (Line line in lines)
{
if (alpha < 0 || beta < 0 || gamma < 0)
{
RotateBy(line, _rotateArrayGamma);
RotateBy(line, _rotateArrayBeta);
RotateBy(line, _rotateArrayAlpha);
}
else
{
RotateBy(line, _rotateArrayAlpha);
RotateBy(line, _rotateArrayBeta);
RotateBy(line, _rotateArrayGamma);
}
}
}
currentAngle = new PointD(currentAngle.X + alpha, currentAngle.Y + beta, currentAngle.Z + gamma);
BasePoint = faces[0].Lines[0].Start;
}
public Line(PointD start, PointD end)
{
Start = start;
End = end;
}