public Sfera(float radius, uint subdivisions, Vec4 color)
{
Mesh ico20 = BuildIcosahedron(radius, color);
Queue <Tri> tris = new Queue <Tri>();
foreach (var item in ico20)
{
tris.Enqueue(item);
}
uint j = 0;
while (subdivisions > j)
{
for (int i = 0; i < 20 * Math.Pow(4, j); i++)
{
Tri t = tris.Dequeue();
Wierzcholek newV0 = ComputeHalfVertex(t.W0, t.W1, radius);
Wierzcholek newV1 = ComputeHalfVertex(t.W1, t.W2, radius);
Wierzcholek newV2 = ComputeHalfVertex(t.W2, t.W0, radius);
tris.Enqueue(new Tri(t.W0, newV0, newV2, t.KS, t.KD, t.N));
tris.Enqueue(new Tri(t.W1, newV1, newV0, t.KS, t.KD, t.N));
tris.Enqueue(new Tri(t.W2, newV2, newV1, t.KS, t.KD, t.N));
tris.Enqueue(new Tri(newV0, newV1, newV2, t.KS, t.KD, t.N));
}
j++;
}
foreach (var item in tris)
{
Trojkaty.Add(item);
}
}
public Tri(Tri t)
{
W0 = t.W0;
W1 = t.W1;
W2 = t.W2;
KS = t.KS;
KD = t.KD;
N = t.N;
}
private void RysujTrojkat(Tri triangle, PrimitiveType primitiveType)
{
if (primitiveType == PrimitiveType.Triangles)
{
void uzupelnijdol(Wierzcholek v1, Wierzcholek v2, Wierzcholek v3)
{
float invslope1 = (v2.Position.X - v1.Position.X) / (v2.Position.Y - v1.Position.Y);
float invslope2 = (v3.Position.X - v1.Position.X) / (v3.Position.Y - v1.Position.Y);
float curx1 = v1.Position.X;
float curx2 = v1.Position.X;
for (int scanlineY = (int)v1.Position.Y; scanlineY <= v2.Position.Y; scanlineY++)
{
float z1 = v1.Position.Z + ((float)(scanlineY - v1.Position.Y) / (float)(v2.Position.Y - v1.Position.Y)) * (v2.Position.Z - v1.Position.Z);
float z2 = v1.Position.Z + ((float)(scanlineY - v1.Position.Y) / (float)(v3.Position.Y - v1.Position.Y)) * (v3.Position.Z - v1.Position.Z);
Vec4 c1 = v1.Color + ((float)(scanlineY - v1.Position.Y) / (float)(v2.Position.Y - v1.Position.Y)) * (v2.Color - v1.Color);
Vec4 c2 = v1.Color + ((float)(scanlineY - v1.Position.Y) / (float)(v3.Position.Y - v1.Position.Y)) * (v3.Color - v1.Color);
Vec3 from = new Vec3((float)Math.Round(curx1), scanlineY, z1);
Vec3 to = new Vec3((float)Math.Round(curx2), scanlineY, z2);
UstawLinie(from.X, from.Z, c1, to.X, to.Z, c2, scanlineY);
curx1 += invslope1;
curx2 += invslope2;
}
}
void uzupelnijgore(Wierzcholek v1, Wierzcholek v2, Wierzcholek v3)
{
float invslope1 = (v3.Position.X - v1.Position.X) / (v3.Position.Y - v1.Position.Y);
float invslope2 = (v3.Position.X - v2.Position.X) / (v3.Position.Y - v2.Position.Y);
float curx1 = v3.Position.X;
float curx2 = v3.Position.X;
for (int scanlineY = (int)v3.Position.Y; scanlineY > v1.Position.Y; scanlineY--)
{
float z1 = v3.Position.Z + ((float)(scanlineY - v3.Position.Y) / (float)(v1.Position.Y - v3.Position.Y)) * (v1.Position.Z - v3.Position.Z);
float z2 = v3.Position.Z + ((float)(scanlineY - v3.Position.Y) / (float)(v2.Position.Y - v3.Position.Y)) * (v2.Position.Z - v3.Position.Z);
Vec3 from = new Vec3((float)Math.Round(curx1), scanlineY, z1);
Vec3 to = new Vec3((float)Math.Round(curx2), scanlineY, z2);
Vec4 c1 = v3.Color + ((float)(scanlineY - v3.Position.Y) / (float)(v1.Position.Y - v3.Position.Y)) * (v1.Color - v3.Color);
Vec4 c2 = v3.Color + ((float)(scanlineY - v3.Position.Y) / (float)(v2.Position.Y - v3.Position.Y)) * (v2.Color - v3.Color);
UstawLinie(from.X, from.Z, c1, to.X, to.Z, c2, scanlineY);
curx1 -= invslope1;
curx2 -= invslope2;
}
}
List <Wierzcholek> sortedVecs = new List <Wierzcholek>
{
triangle[0],
triangle[1],
triangle[2],
};
sortedVecs = sortedVecs.OrderBy(i => i.Position.Y).ToList();
Wierzcholek A = sortedVecs[0];
Wierzcholek B = sortedVecs[1];
Wierzcholek C = sortedVecs[2];
A.Position = new Vec3((int)A.Position.X, (int)A.Position.Y, A.Position.Z);
B.Position = new Vec3((int)B.Position.X, (int)B.Position.Y, B.Position.Z);
C.Position = new Vec3((int)C.Position.X, (int)C.Position.Y, C.Position.Z);
if (B.Position.Y == C.Position.Y)
{
uzupelnijdol(A, B, C);
}
else if (A.Position.Y == B.Position.Y)
{
uzupelnijgore(A, B, C);
}
else
{
float z = A.Position.Z + ((float)(B.Position.Y - A.Position.Y) / (float)(C.Position.Y - A.Position.Y)) * (C.Position.Z - A.Position.Z);
Vec4 c = A.Color + ((float)(B.Position.Y - A.Position.Y) / (float)(C.Position.Y - A.Position.Y)) * (C.Color - A.Color);
Vec3 v4 = new Vec3(
(int)(A.Position.X + ((float)(B.Position.Y - A.Position.Y) / (float)(C.Position.Y - A.Position.Y)) * (C.Position.X - A.Position.X)),
B.Position.Y,
z
);
Wierzcholek v = new Wierzcholek(v4, c);
uzupelnijdol(A, B, v);
uzupelnijgore(B, v, C);
}
}
}
private List <Tri> Clipowanie(Vec3 planePoint, Vec3 planeNormal, Tri tri)
{
planeNormal = planeNormal.Normal();
float dist(Vec3 point)
{
return(planeNormal.Dot(point) - planeNormal.Dot(planePoint));
}
Wierzcholek[] insidePoints = new Wierzcholek[3]; int nInsidePointCount = 0;
Wierzcholek[] outsidePoints = new Wierzcholek[3]; int nOutsidePointCount = 0;
float d0 = dist(tri[0].Position);
float d1 = dist(tri[1].Position);
float d2 = dist(tri[2].Position);
if (d0 >= 0)
{
insidePoints[nInsidePointCount++] = tri[0];
}
else
{
outsidePoints[nOutsidePointCount++] = tri[0];
}
if (d1 >= 0)
{
insidePoints[nInsidePointCount++] = tri[1];
}
else
{
outsidePoints[nOutsidePointCount++] = tri[1];
}
if (d2 >= 0)
{
insidePoints[nInsidePointCount++] = tri[2];
}
else
{
outsidePoints[nOutsidePointCount++] = tri[2];
}
if (nInsidePointCount == 0)
{
return(new List <Tri>());
}
if (nInsidePointCount == 1 && nOutsidePointCount == 2)
{
Wierzcholek v0 = insidePoints[0];
Wierzcholek v1 = Linia(planePoint, planeNormal, v0, outsidePoints[0]);
Wierzcholek v2 = Linia(planePoint, planeNormal, v0, outsidePoints[1]);
Tri t = new Tri(tri)
{
W0 = v0, W1 = v1, W2 = v2
};
if (tri.NormalVector.Z * t.NormalVector.Z < 0)
{
Wierzcholek tmp = t[1];
t[1] = t[2];
t[2] = tmp;
}
return(new List <Tri>
{
t,
});
}
if (nInsidePointCount == 2 && nOutsidePointCount == 1)
{
Wierzcholek v00 = insidePoints[0];
Wierzcholek v01 = insidePoints[1];
Wierzcholek v02 = Linia(planePoint, planeNormal, v00, outsidePoints[0]);
Wierzcholek v10 = insidePoints[1];
Wierzcholek v11 = v02;
Wierzcholek v12 = Linia(planePoint, planeNormal, v10, outsidePoints[0]);
Tri t1 = new Tri(tri)
{
W0 = v00, W1 = v01, W2 = v02
};
Tri t2 = new Tri(tri)
{
W0 = v10, W1 = v11, W2 = v12
};
if (tri.NormalVector.Z * t1.NormalVector.Z < 0)
{
Wierzcholek tmp = t1[1];
t1[1] = t1[2];
t1[2] = tmp;
}
if (tri.NormalVector.Z * t2.NormalVector.Z < 0)
{
Wierzcholek tmp = t2[1];
t2[1] = t2[2];
t2[2] = tmp;
}
return(new List <Tri>
{
t1,
t2,
});
}
if (nInsidePointCount == 3)
{
return(new List <Tri>
{
tri,
});
}
return(new List <Tri>());
}
//rysowanie trojkatow skierowanych do mnie z cieniem i przycieciem
public void RenderowanieSceny(Scena scene, RenderTarget target, RenderStates states)
{
uint width = target.Size.X;
uint height = target.Size.Y;
Buffer = new float[width, height];
Bitmap = new Color[width, height];
Transformacja cameraInvMatrixAndWorld = scene.mainCamera.InverseTransform * scene.worldTransform;
Transformacja matView = Transformacja.Identity.Translate(new Vec3(1, 1, 0)).Scale(new Vec3(width / 2, height / 2, 1));
float fAspectRatio = height / (float)width;
float fFovRad = 1.0f / (float)Math.Tan(scene.mainCamera.Fov * 0.5f / 180.0f * Math.PI);
float[,] m = new float[4, 4];
m[0, 0] = fAspectRatio * fFovRad;
m[1, 1] = fFovRad;
m[2, 2] = scene.mainCamera.Daleko / (scene.mainCamera.Daleko - scene.mainCamera.Blisko);
m[3, 2] = (-scene.mainCamera.Daleko * scene.mainCamera.Blisko) / (scene.mainCamera.Daleko - scene.mainCamera.Blisko);
m[2, 3] = 1.0f;
m[3, 3] = 0.0f;
Transformacja matProj = new Transformacja(m);
Transformacja matProjAndView = matView * matProj;
Queue <Tri> sceneTriangles = new Queue <Tri>();
foreach (Rysowalne drawable in scene.drawables)
{
Mesh mesh = drawable.GetMesh();
foreach (Tri tri in mesh)
{
sceneTriangles.Enqueue(mesh.Transform * tri);
}
}
int c = sceneTriangles.Count;
for (int i = 0; i < c; i++)
{
Tri t = sceneTriangles.Dequeue();
sceneTriangles.Enqueue(cameraInvMatrixAndWorld * t);
}
for (int i = 0; i < c; i++)
{
Tri t = sceneTriangles.Dequeue();
List <Tri> clt = Clipowanie(new Vec3(0, 0, scene.mainCamera.Blisko), new Vec3(0, 0, 1), t);
foreach (var clippedTriangle in clt)
{
sceneTriangles.Enqueue(clippedTriangle);
}
}
c = sceneTriangles.Count;
for (int i = 0; i < c; i++)
{
Tri t = sceneTriangles.Dequeue();
if (t.NormalVector.Dot(t[0].Position) < 0)
{
sceneTriangles.Enqueue(t);
}
}
c = sceneTriangles.Count;
for (int i = 0; i < c; i++)
{
Tri t = sceneTriangles.Dequeue();
float[] Is = new float[3] {
0, 0, 0
};
Vec3 N = t.NormalVector;
float kd = t.KD;
float ks = t.KS;
float n = t.N;
foreach (ZrodloSwiatla lsrc in scene.Lampy)
{
Vec3 lightPos = cameraInvMatrixAndWorld * lsrc.Position;
for (int j = 0; j < 3; j++)
{
Vec3 V = (-t[j].Position).Normal();
Vec3 L = (lightPos - t[j].Position).Normal();
Vec3 R = (-L - 2 * N.Dot(-L) * N).Normal();
float minus = (V.Dot(R) < 0) ? -1 : 1;
float I = lsrc.Intensywnosc * (kd * N.Dot(L) + ks * minus * (float)Math.Pow(V.Dot(R), n));
Math.Max(I, 0);
Is[j] += I;
}
}
for (int j = 0; j < 3; j++)
{
Is[j] = Math.Max(Is[j], 0.2f);
}
Vec4 color0 = new Vec4(t[0].Color.R * Is[0], t[0].Color.G * Is[0], t[0].Color.B * Is[0], t[0].Color.A);
Vec4 color1 = new Vec4(t[1].Color.R * Is[1], t[1].Color.G * Is[1], t[1].Color.B * Is[1], t[1].Color.A);
Vec4 color2 = new Vec4(t[2].Color.R * Is[2], t[2].Color.G * Is[2], t[2].Color.B * Is[2], t[2].Color.A);
Wierzcholek vert0 = new Wierzcholek(t[0].Position, color0);
Wierzcholek vert1 = new Wierzcholek(t[1].Position, color1);
Wierzcholek vert2 = new Wierzcholek(t[2].Position, color2);
sceneTriangles.Enqueue(new Tri(vert0, vert1, vert2, t.KS, t.KD, t.N));
}
for (int i = 0; i < c; i++)
{
Tri t = sceneTriangles.Dequeue();
sceneTriangles.Enqueue(matProjAndView * t);
}
for (int i = 0; i < c; i++)
{
Tri t = sceneTriangles.Dequeue();
Queue <Tri> qTris = new Queue <Tri>();
qTris.Enqueue(t);
int nNewTriangles = 1;
for (int p = 0; p < 4; p++)
{
while (nNewTriangles > 0)
{
Tri t2 = qTris.Dequeue();
nNewTriangles--;
List <Tri> clippedTriangles = new List <Tri>();
switch (p)
{
case 0:
clippedTriangles = Clipowanie(new Vec3(), new Vec3(0, 1, 0), t2);
break;
case 1:
clippedTriangles = Clipowanie(new Vec3(0, height - 1, 0), new Vec3(0, -1, 0), t2);
break;
case 2:
clippedTriangles = Clipowanie(new Vec3(), new Vec3(1, 0, 0), t2);
break;
case 3:
clippedTriangles = Clipowanie(new Vec3(width - 1, 0, 0), new Vec3(-1, 0, 0), t2);
break;
}
foreach (var item in clippedTriangles)
{
qTris.Enqueue(item);
}
}
nNewTriangles = qTris.Count;
}
foreach (var item in qTris)
{
sceneTriangles.Enqueue(item);
}
}
while (sceneTriangles.Count > 0)
{
Tri t = sceneTriangles.Dequeue();
RysujTrojkat(t, PrimitiveType.Triangles);
}
foreach (ZrodloSwiatla light in scene.Lampy)
{
Vec3 lpos = cameraInvMatrixAndWorld * light.Position;
if (lpos.Z > 0)
{
Vec3 lPosOnScreen = matProjAndView * lpos;
UstawPixel(lPosOnScreen, (Vec4)Color.White);
UstawPixel(lPosOnScreen + new Vec3(0, 1), (Vec4)Color.White);
UstawPixel(lPosOnScreen + new Vec3(1, 0), (Vec4)Color.White);
UstawPixel(lPosOnScreen + new Vec3(1, 1), (Vec4)Color.White);
}
}
Image img = new Image(Bitmap);
Texture texture = new Texture(img);
Sprite s = new Sprite(texture);
target.Draw(s, states);
s.Dispose();
texture.Dispose();
img.Dispose();
}