public void Draw3D(int width, int height, Graphics g, Bitmap bm, float koef, bool isLightFromCamera, bool buffer)
{
Random rnd;
double vCos = (float)Math.Cos(Math.PI * beta / 180),
vSin = (float)Math.Sin(Math.PI * beta / 180);
float cos = (float)Math.Cos(Math.PI * alpha / 180),
sin = (float)Math.Sin(Math.PI * alpha / 180);
float maxR = (float)data.Vertices.Select(tup =>
Math.Sqrt(tup.Item1 * tup.Item1 + tup.Item2 * tup.Item2)).Max();
int min = (width > height) ? height : width;
float k = min * 0.5f / maxR * 0.9f * koef;
rnd = new Random();
float[,] ZBuffer = new float[height, width];
for (int i = 0; i < ZBuffer.GetLength(0); i++)
{
for (int j = 0; j < ZBuffer.GetLength(1); j++)
{
ZBuffer[i, j] = float.MinValue;
}
}
foreach (var polygon in data.Faces)
{
var P = polygon.Select(t =>
new Tuple <double, double, double>(data.Vertices[t.Item1 - 1].Item1, data.Vertices[t.Item1 - 1].Item2, data.Vertices[t.Item1 - 1].Item3)).ToArray();
double[,] vecs = new double[2, 3] {
{ P[1].Item1 - P[0].Item1, P[1].Item2 - P[0].Item2, P[1].Item3 - P[0].Item3 },
{ P[2].Item1 - P[0].Item1, P[2].Item2 - P[0].Item2, P[2].Item3 - P[0].Item3 }
};
var NVect = new double[3] {
vecs[0, 1] * vecs[1, 2] - vecs[1, 1] * vecs[0, 2],
vecs[1, 0] * vecs[0, 2] - vecs[0, 0] * vecs[1, 2],
vecs[0, 0] * vecs[1, 1] - vecs[1, 0] * vecs[0, 1]
};
double VecMultiplyBackFaceCulling = -NVect[0] * sin * vCos + NVect[1] * vSin + NVect[2] * cos * vCos;
double CosAlphaBFC = VecMultiplyBackFaceCulling / Math.Sqrt(NVect[0] * NVect[0] + NVect[1] * NVect[1] + NVect[2] * NVect[2]);
double VecMultiplyLight, CosAlphaLight;
if (isLightFromCamera)
{
CosAlphaLight = CosAlphaBFC;
}
else
{
VecMultiplyLight = NVect[2];
CosAlphaLight = VecMultiplyLight / Math.Sqrt(NVect[0] * NVect[0] + NVect[1] * NVect[1] + NVect[2] * NVect[2]);
}
if (CosAlphaBFC >= 0)
{
CosAlphaLight = -Math.Abs(Math.Acos(CosAlphaLight)) / Math.PI + 1;//optional
float dx = x * koef + width * 0.5f,
dy = y * koef + height * 0.5f;
var pointsMatrix = new MathExt.Matrix(ArrayConcat(P));
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ cos, 0, sin, 0 }, { 0, 1, 0, 0 }, { -sin, 0, cos, 0 }, { 0, 0, 0, 1 }
});
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ 1, 0, 0, 0 }, { 0, vCos, -vSin, 0 }, { 0, vSin, vCos, 0 }, { 0, 0, 0, 1 }
});
if (IsWithPerspective)
{
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ 1, 0, 0, 0 }, { 0, 1, 0, 0 }, { 0, 0, 1, 0 }, { 0, 0, -0.2f, 1 }
});
}
pointsMatrix = pointsMatrix.Project();
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ 1, 0, 0 }, { 0, -1, 0 }, { 0, 0, 1 }
});
pointsMatrix = pointsMatrix.MultiplyByNumber(k);
pointsMatrix = pointsMatrix.Resize(1).MultiplyLeft(new double[, ]
{
{ 1, 0, 0, dx }, { 0, 1, 0, dy }, { 0, 0, 1, 0 }, { 0, 0, 0, 1 }
}).Resize(-1);
var ps = PolygonFromMatrix(pointsMatrix.data).Select(p => new PointF(p.X, p.Y)).ToArray();
Color color;
if (IsNeedShadows)
{
color = Color.FromArgb(Convert.ToInt32(204 * CosAlphaLight), Convert.ToInt32(184 * CosAlphaLight), Convert.ToInt32(132 * CosAlphaLight));
}
else
{
double col = 0.8 + 0.2 * rnd.NextDouble();
color = Color.FromArgb(Convert.ToInt32(204 * col), Convert.ToInt32(184 * col), Convert.ToInt32(132 * col));
}
if (buffer)
{
#region Z-Buffer
if (ps.Length == 3)
{
var maxX = (int)ps.Max(p => p.X);
var maxY = (int)ps.Max(p => p.Y);
var minX = (int)ps.Min(p => p.X);
var minY = (int)ps.Min(p => p.Y);
var matrix = pointsMatrix.data;
Vector3D[] a = new Vector3D[3];
for (int m = 0; m < 3; m++)
{
a[m] = new Vector3D(matrix[0, m], matrix[1, m], matrix[2, m]);
}
var v1 = a[1] - a[0];
var v2 = a[2] - a[0];
var ABC = new float[3];
ABC[0] = v1.y * v2.z - v1.z * v2.y;
ABC[1] = v2.x * v1.z - v1.x * v2.z;
ABC[2] = v1.x * v2.y - v1.y * v2.x;
var zKoef = (ABC[0] * a[2].x + ABC[1] * a[2].y + ABC[2] * a[2].z) / ABC[2];
for (int i = minX; i <= maxX; i++)
{
for (int j = minY; j <= maxY; j++)
{
if (!(i < 0 || j < 0 || i >= width || j >= height))
{
var p = new PointF(i, j);
if (PointInTriangle(p, ps[0], ps[1], ps[2]))
{
float z = zKoef - (ABC[0] * i + ABC[1] * j) / ABC[2];
if (z >= ZBuffer[j, i])
{
ZBuffer[j, i] = z;
bm.SetPixel(i, j, color);
//g.FillRectangle(new SolidBrush(color), i, j, 1, 1);
}
}
}
}
}
}
#endregion
}
else
{
g.FillPolygon(new SolidBrush(color), ps);
}
}
}
}
public void DrawWithTextures(int width, int height, Bitmap bm, float koef, string textureName, bool nVecs, bool isLightFromCamera)
{
Bitmap tbm = FileExecutor.TextureOpen(textureName);
double vCos = (float)Math.Cos(Math.PI * beta / 180),
vSin = (float)Math.Sin(Math.PI * beta / 180);
float cos = (float)Math.Cos(Math.PI * alpha / 180),
sin = (float)Math.Sin(Math.PI * alpha / 180);
float maxR = (float)data.Vertices.Select(tup =>
Math.Sqrt(tup.Item1 * tup.Item1 + tup.Item2 * tup.Item2)).Max();
int min = (width > height) ? height : width;
float k = min * 0.5f / maxR * 0.9f * koef;
float[,] ZBuffer = new float[height, width];
for (int i = 0; i < ZBuffer.GetLength(0); i++)
{
for (int j = 0; j < ZBuffer.GetLength(1); j++)
{
ZBuffer[i, j] = float.MinValue;
}
}
foreach (var polygon in data.Faces)
{
var P = polygon.Select(t =>
new Tuple <double, double, double>(data.Vertices[t.Item1 - 1].Item1, data.Vertices[t.Item1 - 1].Item2, data.Vertices[t.Item1 - 1].Item3)).ToArray();
var pointsMatrix = new MathExt.Matrix(ArrayConcat(P));
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ cos, 0, sin, 0 }, { 0, 1, 0, 0 }, { -sin, 0, cos, 0 }, { 0, 0, 0, 1 }
});
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ 1, 0, 0, 0 }, { 0, vCos, -vSin, 0 }, { 0, vSin, vCos, 0 }, { 0, 0, 0, 1 }
});
double[,] vecs;
if (IsWithPerspective)
{
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ 1, 0, 0, 0 }, { 0, 1, 0, 0 }, { 0, 0, 1, 0 }, { 0, 0, -0.2f, 1 }
});
var m = pointsMatrix.Project().data;
vecs = new double[, ] {
{ m[0, 1] - m[0, 0], m[1, 1] - m[1, 0], m[2, 1] - m[2, 0] },
{ m[0, 2] - m[0, 0], m[1, 2] - m[1, 0], m[2, 2] - m[2, 0] }
};
}
pointsMatrix = pointsMatrix.Project();
vecs = new double[2, 3] {
{ P[1].Item1 - P[0].Item1, P[1].Item2 - P[0].Item2, P[1].Item3 - P[0].Item3 },
{ P[2].Item1 - P[0].Item1, P[2].Item2 - P[0].Item2, P[2].Item3 - P[0].Item3 }
};
var NVect = new double[3] {
vecs[0, 1] * vecs[1, 2] - vecs[1, 1] * vecs[0, 2],
vecs[1, 0] * vecs[0, 2] - vecs[0, 0] * vecs[1, 2],
vecs[0, 0] * vecs[1, 1] - vecs[1, 0] * vecs[0, 1]
};
double VecMultiplyBackFaceCulling = -NVect[0] * sin * vCos + NVect[1] * vSin + NVect[2] * cos * vCos;
double CosAlphaBFC = VecMultiplyBackFaceCulling / Math.Sqrt(NVect[0] * NVect[0] + NVect[1] * NVect[1] + NVect[2] * NVect[2]);
double CosAlphaLight, VecMultiplyLight;
VecMultiplyLight = NVect[2];
if (isLightFromCamera)
{
CosAlphaLight = CosAlphaBFC;
}
else
{
CosAlphaLight = VecMultiplyLight / Math.Sqrt(NVect[0] * NVect[0] + NVect[1] * NVect[1] + NVect[2] * NVect[2]);
}
if (CosAlphaBFC >= 0)
{
CosAlphaLight = -Math.Abs(Math.Acos(CosAlphaLight)) / Math.PI + 1;//optional
float dx = x * koef + width * 0.5f,
dy = y * koef + height * 0.5f;
pointsMatrix = pointsMatrix.MultiplyLeft(new double[, ] {
{ 1, 0, 0 }, { 0, -1, 0 }, { 0, 0, 1 }
});
pointsMatrix = pointsMatrix.MultiplyByNumber(k);
pointsMatrix = pointsMatrix.Resize(1).MultiplyLeft(new double[, ]
{
{ 1, 0, 0, dx }, { 0, 1, 0, dy }, { 0, 0, 1, 0 }, { 0, 0, 0, 1 }
}).Resize(-1);
var ps = PolygonFromMatrix(pointsMatrix.data).Select(p => new PointF(p.X, p.Y)).ToArray();
var color = Color.FromArgb(Convert.ToInt32(204 * CosAlphaLight), Convert.ToInt32(184 * CosAlphaLight), Convert.ToInt32(132 * CosAlphaLight));
if (ps.Length == 3)
{
Vector3D lightVector;
if (isLightFromCamera)
{
lightVector = new Vector3D(-sin * vCos, vSin, cos * vCos);
}
else
{
lightVector = new Vector3D(0, 0, 1);
}
PointF[] TextureCoord = polygon.Select(x => (data.VT[x.Item2 - 1])).ToArray();
Vector3D[] nVectors = null;
if (nVecs)
{
nVectors = polygon.Select(x =>
{
var vecTupl = data.VN[x.Item3 - 1];
return(new Vector3D(vecTupl.Item1, vecTupl.Item2, vecTupl.Item3));
}).ToArray();
}
var maxX = (int)ps.Max(p => p.X);
var maxY = (int)ps.Max(p => p.Y);
var minX = (int)ps.Min(p => p.X);
var minY = (int)ps.Min(p => p.Y);
var matrix = pointsMatrix.data;
Vector3D[] a = new Vector3D[3];
for (int m = 0; m < 3; m++)
{
a[m] = new Vector3D(matrix[0, m], matrix[1, m], matrix[2, m]);
}
PointF ab = Minus(ps[1], ps[0]),
ac = Minus(ps[2], ps[0]);
float c = ab.X * ac.Y - ac.X * ab.Y;
PointF tAB = Minus(TextureCoord[1], TextureCoord[0]),
tAC = Minus(TextureCoord[2], TextureCoord[0]);
var v1 = a[1] - a[0];
var v2 = a[2] - a[0];
var ABC = new float[3];
ABC[0] = v1.y * v2.z - v1.z * v2.y;
ABC[1] = v2.x * v1.z - v1.x * v2.z;
ABC[2] = v1.x * v2.y - v1.y * v2.x;
var zKoef = (ABC[0] * a[2].x + ABC[1] * a[2].y + ABC[2] * a[2].z) / ABC[2];
for (int i = minX; i <= maxX; i++)
{
for (int j = minY; j <= maxY; j++)
{
if (!(i < 0 || j < 0 || i >= width || j >= height))
{
var p = new PointF(i, j);
if (PointInTriangle(p, ps[0], ps[1], ps[2]))
{
float z = zKoef - (ABC[0] * i + ABC[1] * j) / ABC[2];
if (z >= ZBuffer[j, i])
{
PointF pa = Minus(ps[0], new PointF(i, j));
float u = (ac.X * pa.Y - pa.X * ac.Y) / c;
float v = (pa.X * ab.Y - ab.X * pa.Y) / c;
PointF coord = Sum(TextureCoord[0], Sum(Multiply(u, tAB), Multiply(v, tAC)));
if (IsNeedShadows)
{
if (nVecs)
{
var normVec = nVectors[0] * (1 - u - v) + nVectors[1] * u + nVectors[2] * v;
CosAlphaLight = (normVec * lightVector) / (normVec.Abs() * lightVector.Abs()) / 2 + 0.5f;
}
}
else
{
CosAlphaLight = 1;
}
color = tbm.GetPixel(Convert.ToInt16(coord.X * tbm.Width) % tbm.Width, Convert.ToInt16((1 - coord.Y % 1) * tbm.Height) % tbm.Height);
color = Color.FromArgb(Convert.ToInt16(color.R * CosAlphaLight), Convert.ToInt16(color.G * CosAlphaLight), Convert.ToInt16(color.B * CosAlphaLight));
ZBuffer[j, i] = z;
bm.SetPixel(i, j, color);
}
}
}
}
}
}
}
}
}