private IEnumerable <TrackComplexModelEntry> LoadModels()
{
var directory = Path.GetDirectoryName(_modelsIniFilename) ?? "";
return(from section in new IniFile(_modelsIniFilename).GetSections("MODEL")
let rot = section.GetSlimVector3("ROTATION")
select new TrackComplexModelEntry {
Kn5 = Kn5.FromFile(Path.Combine(directory, section.GetNonEmpty("FILE") ?? "")),
Matrix = Matrix.Translation(section.GetSlimVector3("POSITION")) * Matrix.RotationYawPitchRoll(rot.X, rot.Y, rot.Z),
});
}
/// <summary> Draw outlined box.</summary>
/// <remarks> Nesox, 2013-12-28.</remarks>
/// <param name="center"> The min. </param>
/// <param name="length"> The length. </param>
/// <param name="width"> The width. </param>
/// <param name="height"> The height. </param>
/// <param name="color"> The color. </param>
public static void DrawOutlinedBox(Vector3 center, float length, float width, float height, Color color)
{
float w = width / 2;
float h = height / 2;
float d = length / 2;
Matrix mat = Matrix.Identity * Matrix.Scaling(w, d, h) * Matrix.Translation(center);
Device.SetTransform(TransformState.World, mat);
var min = new Vector3(-1, -1, 0);
var max = new Vector3(1, 1, 1);
var vtx = new[]
{
new ColoredVertex(new Vector3(min.X, max.Y, max.Z), color.ToArgb()),
new ColoredVertex(new Vector3(max.X, max.Y, max.Z), color.ToArgb()),
new ColoredVertex(new Vector3(min.X, min.Y, max.Z), color.ToArgb()),
new ColoredVertex(new Vector3(max.X, min.Y, max.Z), color.ToArgb()),
new ColoredVertex(new Vector3(min.X, min.Y, min.Z), color.ToArgb()),
new ColoredVertex(new Vector3(max.X, min.Y, min.Z), color.ToArgb()),
new ColoredVertex(new Vector3(min.X, max.Y, min.Z), color.ToArgb()),
new ColoredVertex(new Vector3(max.X, max.Y, min.Z), color.ToArgb())
};
var ind = new short[]
{
//Top [_]
0, 1, 1, 3,
3, 2, 2, 0,
//Bottom [_]
6, 7, 7, 5,
5, 4, 4, 6,
// Back | |
0, 6, 1, 7,
// Front | |
2, 4, 3, 5,
// Left | |
0, 6, 2, 4,
// Right | |
1, 7, 3, 5
};
var oldDecl = Device.VertexDeclaration;
using (var newDecl = ColoredVertex.GetDecl(Device))
{
Device.VertexDeclaration = newDecl;
Device.DrawIndexedUserPrimitives(PrimitiveType.LineList, 0, 8, 12, ind, Format.Index16, vtx, 16);
Device.VertexDeclaration = oldDecl;
}
}
/// <summary>
/// Возвращает матрицу в системе координат DirectX
/// </summary>
/// <param name="frame">Фрейм</param>
/// <returns></returns>
public static Matrix ToDirectXMatrix(this Frame3D frame)
{
//Если нет кватерниона - поворачиваем исходя из Pitch, yaw, roll - иначе через кватернион.
if (!frame.Orientation.HasValue)
{
return(Matrix.RotationYawPitchRoll((float)frame.Pitch.Radian,
(float)frame.Roll.Radian, -(float)frame.Yaw.Radian) *
Matrix.Translation(-(float)frame.X, (float)frame.Y, (float)frame.Z));
}
Quat quat = frame.Orientation.Value;
var q = new Quaternion((float)quat.X, (float)quat.Y, (float)quat.Z, (float)quat.W);
return(Matrix.RotationQuaternion(q) *
Matrix.Translation(-(float)frame.X, (float)frame.Y, (float)frame.Z));
}
/// <summary> Draw box. </summary>
/// <remarks> Nesox, 2013-06-14. </remarks>
/// <param name="center"> The min. </param>
/// <param name="length"> The length. </param>
/// <param name="width"> The width. </param>
/// <param name="height"> The height. </param>
/// <param name="color"> The color. </param>
public static void DrawBox(Vector3 center, float length, float width, float height, Color color)
{
length /= 2f;
width /= 2f;
height /= 2f;
var extents = new Vector3(width, length, height);
Device.SetTransform(TransformState.World, Matrix.Translation(center.X, center.Y, center.Z));
var vtx = new[]
{
new ColoredVertex(new Vector3(-extents.X, extents.Y, extents.Z), color.ToArgb()),
new ColoredVertex(new Vector3(extents.X, extents.Y, extents.Z), color.ToArgb()),
new ColoredVertex(new Vector3(extents.X, -extents.Y, extents.Z), color.ToArgb()),
new ColoredVertex(new Vector3(-extents.X, -extents.Y, extents.Z), color.ToArgb()),
new ColoredVertex(new Vector3(-extents.X, extents.Y, -extents.Z), color.ToArgb()),
new ColoredVertex(new Vector3(extents.X, extents.Y, -extents.Z), color.ToArgb()),
new ColoredVertex(new Vector3(extents.X, -extents.Y, -extents.Z), color.ToArgb()),
new ColoredVertex(new Vector3(-extents.X, -extents.Y, -extents.Z), color.ToArgb())
};
var ind = new short[]
{
// front
0, 1, 2, 2, 3, 0,
// right
1, 5, 6, 6, 2, 1,
// back
5, 4, 7, 7, 6, 5,
// left
4, 0, 3, 3, 7, 4,
// top
4, 5, 1, 1, 0, 4,
// bottom
3, 2, 6, 6, 7, 3
};
var oldDecl = Device.VertexDeclaration;
using (var newDecl = ColoredVertex.GetDecl(Device))
{
Device.VertexDeclaration = newDecl;
Device.DrawIndexedUserPrimitives(PrimitiveType.TriangleList, 0, 8, 12, ind, Format.Index16, vtx, 16);
Device.VertexDeclaration = oldDecl;
}
}
/// <summary> Draws a circle.</summary>
/// <remarks> Nesox, 2013-12-29.</remarks>
/// <param name="center"> The min. </param>
/// <param name="radius"> The radius. </param>
/// <param name="slices"> The slices. </param>
/// <param name="color"> The color. </param>
public static void DrawCircle(Vector3 center, float radius, int slices, Color color)
{
Device.SetTransform(TransformState.World, Matrix.Translation(center.X, center.Y, center.Z));
var min = new Vector3(0, 0, 0);
var radsPerSlice = (float)(Math.PI * 2 / slices);
var vertices = new ColoredVertex[slices + 1];
vertices[0] = new ColoredVertex(min, color.ToArgb());
float curRad = 0;
for (int i = 1; i < slices + 1; i++)
{
var sine = (float)Math.Sin(curRad);
var cosine = (float)Math.Cos(curRad);
vertices[i] = new ColoredVertex(new Vector3(min.X + cosine * radius, min.Y + sine * radius, min.Z), color.ToArgb());
curRad += radsPerSlice;
}
var indices = new int[slices * 3];
for (int i = 0; i < slices; i++)
{
indices[i * 3 + 0] = i + 1;
indices[i * 3 + 1] = i == slices - 1 ? 1 : i + 2;
indices[i * 3 + 2] = 0;
}
Device.VertexFormat = ColoredVertex.Format;
var oldDecl = Device.VertexDeclaration;
using (var newDecl = ColoredVertex.GetDecl(Device))
{
Device.VertexDeclaration = newDecl;
Device.DrawIndexedUserPrimitives(PrimitiveType.TriangleList, 0, vertices.Length, indices.Length / 3, indices, Format.Index32, vertices, ColoredVertex.Stride);
Device.VertexDeclaration = oldDecl;
}
}
/// <summary> Draw 3d text.</summary>
/// <remarks> Nesox, 2013-12-28.</remarks>
/// <param name="text"> The text. </param>
/// <param name="textPos"> The text position. </param>
/// <param name="emSize"> (optional) size of the em. </param>
/// <param name="fontStyle"> (optional) the font style. </param>
public static void Draw3DText(string text, Vector3 textPos, float emSize = 12f,
FontStyle fontStyle = FontStyle.Regular)
{
if (string.IsNullOrWhiteSpace(text))
{
throw new ArgumentException("text must be specified", "text");
}
Device.SetTransform(TransformState.World, Matrix.Translation(textPos.X, textPos.Y, textPos.Z));
Mesh m;
if (!_textMeshCache.TryGetValue(text, out m))
{
_textMeshCache[text] = Mesh.CreateText(Device, new System.Drawing.Font("Verdana", emSize, fontStyle), text, 0.001f, 0.01f);
}
var mesh = _textMeshCache[text];
mesh.DrawSubset(0);
}
/// <summary> Draw triangle. </summary>
/// <remarks> Nesox, 2013-06-14. </remarks>
/// <param name="pos"> my position. </param>
/// <param name="width"> The width. </param>
/// <param name="height"> The height. </param>
/// <param name="color"> The color. </param>
public static void DrawTriangle(Vector3 pos, float width, float height, Color color)
{
// Transformations.
Device.SetTransform(TransformState.World, Matrix.Translation(pos.X, pos.Y, pos.Z));
ColoredVertex[] triangleVerts =
{
new ColoredVertex(new Vector3(0f, 0f, height), color.ToArgb()),
new ColoredVertex(new Vector3(width, -width, 0f), color.ToArgb()),
new ColoredVertex(new Vector3(-width, width, 0f), color.ToArgb())
};
var oldDecl = Device.VertexDeclaration;
using (var newDecl = ColoredVertex.GetDecl(Device))
{
Device.VertexDeclaration = newDecl;
Device.DrawUserPrimitives(PrimitiveType.TriangleList, 1, triangleVerts);
Device.VertexDeclaration = oldDecl;
}
}
public HermiteDataGrid createCubeGrid()
{
return(HermiteDataGrid.FromIntersectableGeometry(gridWorldSize, subdivision, Matrix.Scaling(new Vector3(4)) * Matrix.Translation(5, 5, 5),
new IntersectableCube()));
}
public static void DrawSphere(Vector3 center, float radius, int stacks, int slices, Color color)
{
Device.SetTransform(TransformState.World, Matrix.Translation(center.X, center.Y, center.Z));
var min = new Vector3(0, 0, 0);
//calculates the resulting number of vertices and indices
int numVerts = (stacks + 1) * (slices + 1);
int numInds = 3 * stacks * (slices + 1) * 2;
var indices = new int[numInds];
var vertices = new ColoredVertex[numVerts];
var stackAngle = (float)(Math.PI / stacks);
var sliceAngle = (float)((Math.PI * 2.0) / slices);
int vertIndex = 0;
//Generate the group of stacks for the sphere
int vertCount = 0;
int indCount = 0;
for (int stack = 0; stack < (stacks + 1); stack++)
{
var r = (float)Math.Sin(stack * stackAngle);
var z = (float)Math.Cos(stack * stackAngle);
//Generate the group of segments for the current Stack
for (int slice = 0; slice < (slices + 1); slice++)
{
float x = r * (float)Math.Sin(slice * sliceAngle);
float y = r * (float)Math.Cos(slice * sliceAngle);
vertices[vertCount] = new ColoredVertex(min + new Vector3(x * radius, y * radius, z * radius), color.ToArgb());
vertCount++;
if (stack != (stacks - 1))
{
indices[indCount] = vertIndex + (slices + 1);
indCount++;
indices[indCount] = vertIndex + 1;
indCount++;
indices[indCount] = vertIndex;
indCount++;
indices[indCount] = vertIndex + (slices);
indCount++;
indices[indCount] = vertIndex + (slices + 1);
indCount++;
indices[indCount] = vertIndex;
indCount++;
vertIndex++;
}
}
}
using (VertexBuffer vbSphere = new VertexBuffer(Device, vertices.Length * ColoredVertex.Stride, Usage.WriteOnly, ColoredVertex.Format, Pool.Default))
using (IndexBuffer ibSphere = new IndexBuffer(Device, indices.Length * sizeof(int), Usage.WriteOnly, Pool.Default, false))
{
using (DataStream sphereIndexDs = ibSphere.Lock(0, indices.Length * sizeof(int), LockFlags.Discard | LockFlags.NoOverwrite))
sphereIndexDs.WriteRange(indices);
using (DataStream sphereVertexDs = vbSphere.Lock(0, vertices.Length * ColoredVertex.Stride, LockFlags.Discard | LockFlags.NoOverwrite))
sphereVertexDs.WriteRange(vertices);
vbSphere.Unlock();
ibSphere.Unlock();
var oldDecl = Device.VertexDeclaration;
using (var newDecl = ColoredVertex.GetDecl(Device))
{
Device.VertexDeclaration = newDecl;
Device.VertexFormat = ColoredVertex.Format;
Device.SetStreamSource(0, vbSphere, 0, ColoredVertex.Stride);
Device.Indices = ibSphere;
Device.DrawIndexedPrimitives(PrimitiveType.TriangleList, 0, 0, vertices.Length, 0, vertices.Length / 3);
//Device.DrawIndexedUserPrimitives(PrimitiveType.LineList, 0, vertices.Length, vertices.Length / 3, indices, Format.Index32, vertices, ColoredVertex.Stride);
Device.VertexDeclaration = oldDecl;
}
}
}
/// <summary> Draws a line. </summary>
/// <param name="vecStartPos"> The vector start position. </param>
/// <param name="vecEndPos"> The vector end position. </param>
/// <param name="width"> The width. </param>
/// <param name="color"> The color. </param>
public static void DrawLineEx(Vector3 vecStartPos, Vector3 vecEndPos, float width, Color color)
{
const int numCorners = 20;
Vector3 start = new Vector3(0.5f, 0.0f, 0.0f);
Vector3 end = new Vector3(-0.5f, 0.0f, 0.0f);
if (_lineVertices == null)
{
_lineVertices = new ColoredVertex[numCorners * 2];
for (int i = 0; i < numCorners; i++)
{
Vector3 offset = new Vector3(0.0f, (float)Math.Cos((2.0f * Math.PI) / numCorners * i),
(float)Math.Sin((2.0f * (float)Math.PI) / numCorners * i));
Vector3 startPoint = start + offset;
ColoredVertex startVert = new ColoredVertex(new Vector3(startPoint.X, startPoint.Y, startPoint.Z), color.ToArgb());
_lineVertices[i] = startVert;
Vector3 endPoint = end + offset;
ColoredVertex endVert = new ColoredVertex(new Vector3(endPoint.X, endPoint.Y, endPoint.Z), color.ToArgb());
_lineVertices[numCorners + i] = endVert;
}
}
if (_lineFaceIndices == null)
{
_lineFaceIndices = new int[numCorners * 2 * 3]; // The number of faces is the same as the number of corners: 2 tris per face, 3 inds per tri
for (int i = 0; i < numCorners; i++)
{
_lineFaceIndices[i * 6 + 0] = i; // ring 1, vert i
_lineFaceIndices[i * 6 + 1] = numCorners + i; // ring 2, vert i
_lineFaceIndices[i * 6 + 2] = (i + 1) % numCorners; // ring 1, vert i + 1
_lineFaceIndices[i * 6 + 3] = (i + 1) % numCorners; // ring 1, vert i + 1
_lineFaceIndices[i * 6 + 4] = i == numCorners - 1 ? numCorners : numCorners + i + 1; // ring 2, vert i + 1
_lineFaceIndices[i * 6 + 5] = numCorners + i; // ring 2, vert i
}
}
Vector3 startToEnd = vecEndPos - vecStartPos;
Matrix scaling = Matrix.Scaling(Vector3.Distance(vecStartPos, vecEndPos), width / 2, width / 2);
Matrix rotationY = Matrix.RotationY(-(float)Math.Asin(startToEnd.Z / Vector3.Distance(vecStartPos, vecEndPos)));
Matrix rotationZ = Matrix.RotationZ((float)Math.Atan2(startToEnd.Y, startToEnd.X));
Matrix rotation = Matrix.Multiply(rotationY, rotationZ);
Matrix translation = Matrix.Translation(start.X + startToEnd.X / 2, start.Y + startToEnd.Y / 2, start.Z + startToEnd.Z / 2);
Matrix world = Matrix.Multiply(Matrix.Multiply(scaling, rotation), translation);
Device.SetTransform(TransformState.World, world);
var oldDecl = Device.VertexDeclaration;
using (var newDecl = ColoredVertex.GetDecl(Device))
{
Device.VertexDeclaration = newDecl;
Device.DrawIndexedUserPrimitives(PrimitiveType.TriangleList, 0, numCorners * 2, numCorners * 2, _lineFaceIndices, Format.Index32, _lineVertices, ColoredVertex.Stride);
Device.VertexDeclaration = oldDecl;
}
}
