1156 lines
43 KiB
C#
1156 lines
43 KiB
C#
/*
|
|
* Copyright (c) Contributors, http://opensimulator.org/
|
|
* See CONTRIBUTORS.TXT for a full list of copyright holders.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are met:
|
|
* * Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* * Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* * Neither the name of the OpenSim Project nor the
|
|
* names of its contributors may be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE DEVELOPERS ``AS IS'' AND ANY
|
|
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL THE CONTRIBUTORS BE LIABLE FOR ANY
|
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
using System;
|
|
using System.Collections.Generic;
|
|
using System.IO;
|
|
using OpenSim.Region.Physics.Manager;
|
|
using OpenMetaverse;
|
|
|
|
namespace OpenSim.Region.Physics.Meshing
|
|
{
|
|
public struct Coord
|
|
{
|
|
public float X;
|
|
public float Y;
|
|
public float Z;
|
|
|
|
public Coord(float x, float y, float z)
|
|
{
|
|
this.X = x;
|
|
this.Y = y;
|
|
this.Z = z;
|
|
}
|
|
|
|
public override string ToString()
|
|
{
|
|
return this.X.ToString() + " " + this.Y.ToString() + " " + this.Z.ToString();
|
|
}
|
|
}
|
|
|
|
public struct Face
|
|
{
|
|
public int v1;
|
|
public int v2;
|
|
public int v3;
|
|
|
|
public Face(int v1, int v2, int v3)
|
|
{
|
|
this.v1 = v1;
|
|
this.v2 = v2;
|
|
this.v3 = v3;
|
|
}
|
|
}
|
|
|
|
internal struct Angle
|
|
{
|
|
internal float angle;
|
|
internal float X;
|
|
internal float Y;
|
|
|
|
internal Angle(float angle, float x, float y)
|
|
{
|
|
this.angle = angle;
|
|
this.X = x;
|
|
this.Y = y;
|
|
}
|
|
}
|
|
|
|
//internal float angles3[][] = [
|
|
//[0.0f, 1.0f, 0.0f],
|
|
//[0.33333333333333331f, -0.49999999999999978f, 0.86602540378443871f],
|
|
//[0.66666666666666663f, -0.50000000000000044f, -0.86602540378443837f],
|
|
//[1.0f, 1.0f, -2.4492127076447545e-016f]];
|
|
/*
|
|
angles3 = [
|
|
[0.0, 1.0, 0.0],
|
|
[0.33333333333333331, -0.49999999999999978, 0.86602540378443871],
|
|
[0.66666666666666663, -0.50000000000000044, -0.86602540378443837],
|
|
[1.0, 1.0, -2.4492127076447545e-016]]
|
|
|
|
angles4 = [
|
|
[0.0, 1.0, 0.0],
|
|
[0.25, 0.0, 1.0],
|
|
[0.5, -1.0, 0.0],
|
|
[0.75, 0.0, -1.0],
|
|
[1.0, 1.0, 0.0]]
|
|
|
|
angles24 = [
|
|
[0.0, 0.5, 0.0],
|
|
[0.041666666666666664, 0.48296291314453416, 0.12940952255126037],
|
|
[0.083333333333333329, 0.43301270189221935, 0.25],
|
|
[0.125, 0.35355339059327379, 0.35355339059327373],
|
|
[0.16666666666666666, 0.25, 0.4330127018922193],
|
|
[0.20833333333333331, 0.12940952255126048, 0.4829629131445341],
|
|
[0.25, 0.0, 0.5],
|
|
[0.29166666666666663, -0.12940952255126031, 0.48296291314453416],
|
|
[0.33333333333333331, -0.25, 0.43301270189221935],
|
|
[0.375, -0.35355339059327373, 0.35355339059327379],
|
|
[0.41666666666666663, -0.43301270189221924, 0.25],
|
|
[0.45833333333333331, -0.4829629131445341, 0.12940952255126051],
|
|
[0.5, -0.5, 0.0],
|
|
[0.54166666666666663, -0.48296291314453421, -0.12940952255126018],
|
|
[0.58333333333333326, -0.43301270189221941, -0.25],
|
|
[0.62499999999999989, -0.35355339059327395, -0.35355339059327356],
|
|
[0.66666666666666663, -0.25, -0.43301270189221919],
|
|
[0.70833333333333326, -0.12940952255126076, -0.48296291314453405],
|
|
[0.75, 0.0, -0.5],
|
|
[0.79166666666666663, 0.12940952255126015, -0.48296291314453421],
|
|
[0.83333333333333326, 0.25, -0.43301270189221952],
|
|
[0.875, 0.35355339059327368, -0.35355339059327384],
|
|
[0.91666666666666663, 0.43301270189221919, -0.25],
|
|
[0.95833333333333326, 0.48296291314453405, -0.12940952255126079],
|
|
[1.0, 0.5, 0.0]]
|
|
|
|
angles24 = [
|
|
[0.0, 1.0, 0.0],
|
|
[0.041666666666666664, 0.96592582628906831, 0.25881904510252074],
|
|
[0.083333333333333329, 0.86602540378443871, 0.5],
|
|
[0.125, 0.70710678118654757, 0.70710678118654746],
|
|
[0.16666666666666667, 0.5, 0.8660254037844386],
|
|
[0.20833333333333331, 0.25881904510252096, 0.9659258262890682],
|
|
[0.25, 6.1230317691118863e-017, 1.0],
|
|
[0.29166666666666663, -0.25881904510252063, 0.96592582628906831],
|
|
[0.33333333333333333, -0.5, 0.86602540378443871],
|
|
[0.375, -0.70710678118654746, 0.70710678118654757],
|
|
[0.41666666666666663, -0.86602540378443849, 0.5],
|
|
[0.45833333333333331, -0.9659258262890682, 0.25881904510252102],
|
|
[0.5, -1.0, 1.2246063538223773e-016],
|
|
[0.54166666666666663, -0.96592582628906842, -0.25881904510252035],
|
|
[0.58333333333333326, -0.86602540378443882, -0.5],
|
|
[0.62499999999999989, -0.70710678118654791, -0.70710678118654713],
|
|
[0.66666666666666667, -0.5, -0.86602540378443837],
|
|
[0.70833333333333326, -0.25881904510252152, -0.96592582628906809],
|
|
[0.75, -1.8369095307335659e-016, -1.0],
|
|
[0.79166666666666663, 0.2588190451025203, -0.96592582628906842],
|
|
[0.83333333333333326, 0.5, -0.86602540378443904],
|
|
[0.875, 0.70710678118654735, -0.70710678118654768],
|
|
[0.91666666666666663, 0.86602540378443837, -0.5],
|
|
[0.95833333333333326, 0.96592582628906809, -0.25881904510252157],
|
|
[1.0, 1.0, -2.4492127076447545e-016]]
|
|
|
|
*/
|
|
|
|
internal class AngleList
|
|
{
|
|
private float iX, iY; // intersection point
|
|
|
|
private Angle[] angles3 =
|
|
{
|
|
new Angle(0.0f, 1.0f, 0.0f),
|
|
new Angle(0.33333333333333333f, -0.5f, 0.86602540378443871f),
|
|
new Angle(0.66666666666666667f, -0.5f, -0.86602540378443837f),
|
|
new Angle(1.0f, 1.0f, 0.0f)
|
|
};
|
|
|
|
private Angle[] angles4 =
|
|
{
|
|
new Angle(0.0f, 1.0f, 0.0f),
|
|
new Angle(0.25f, 0.0f, 1.0f),
|
|
new Angle(0.5f, -1.0f, 0.0f),
|
|
new Angle(0.75f, 0.0f, -1.0f),
|
|
new Angle(1.0f, 1.0f, 0.0f)
|
|
};
|
|
|
|
private Angle[] angles24 =
|
|
{
|
|
new Angle(0.0f, 1.0f, 0.0f),
|
|
new Angle(0.041666666666666664f, 0.96592582628906831f, 0.25881904510252074f),
|
|
new Angle(0.083333333333333329f, 0.86602540378443871f, 0.5f),
|
|
new Angle(0.125f, 0.70710678118654757f, 0.70710678118654746f),
|
|
new Angle(0.16666666666666667f, 0.5f, 0.8660254037844386f),
|
|
new Angle(0.20833333333333331f, 0.25881904510252096f, 0.9659258262890682f),
|
|
new Angle(0.25f, 0.0f, 1.0f),
|
|
new Angle(0.29166666666666663f, -0.25881904510252063f, 0.96592582628906831f),
|
|
new Angle(0.33333333333333333f, -0.5f, 0.86602540378443871f),
|
|
new Angle(0.375f, -0.70710678118654746f, 0.70710678118654757f),
|
|
new Angle(0.41666666666666663f, -0.86602540378443849f, 0.5f),
|
|
new Angle(0.45833333333333331f, -0.9659258262890682f, 0.25881904510252102f),
|
|
new Angle(0.5f, -1.0f, 0.0f),
|
|
new Angle(0.54166666666666663f, -0.96592582628906842f, -0.25881904510252035f),
|
|
new Angle(0.58333333333333326f, -0.86602540378443882f, -0.5f),
|
|
new Angle(0.62499999999999989f, -0.70710678118654791f, -0.70710678118654713f),
|
|
new Angle(0.66666666666666667f, -0.5f, -0.86602540378443837f),
|
|
new Angle(0.70833333333333326f, -0.25881904510252152f, -0.96592582628906809f),
|
|
new Angle(0.75f, 0.0f, -1.0f),
|
|
new Angle(0.79166666666666663f, 0.2588190451025203f, -0.96592582628906842f),
|
|
new Angle(0.83333333333333326f, 0.5f, -0.86602540378443904f),
|
|
new Angle(0.875f, 0.70710678118654735f, -0.70710678118654768f),
|
|
new Angle(0.91666666666666663f, 0.86602540378443837f, -0.5f),
|
|
new Angle(0.95833333333333326f, 0.96592582628906809f, -0.25881904510252157f),
|
|
new Angle(1.0f, 1.0f, 0.0f)
|
|
};
|
|
|
|
private Angle interpolatePoints(float newPoint, Angle p1, Angle p2)
|
|
{
|
|
float m = (newPoint - p1.angle) / (p2.angle - p1.angle);
|
|
return new Angle(newPoint, p1.X + m * (p2.X - p1.X), p1.Y + m * (p2.Y - p1.Y));
|
|
}
|
|
|
|
private void intersection(double x1, double y1, double x2, double y2, double x3, double y3, double x4, double y4)
|
|
{ // ref: http://local.wasp.uwa.edu.au/~pbourke/geometry/lineline2d/
|
|
double denom = (y4 - y3) * (x2 - x1) - (x4 - x3) * (y2 - y1);
|
|
double uaNumerator = (x4 - x3) * (y1 - y3) - (y4 - y3) * (x1 - x3);
|
|
|
|
if (denom != 0.0)
|
|
{
|
|
double ua = uaNumerator / denom;
|
|
iX = (float)(x1 + ua * (x2 - x1));
|
|
iY = (float)(y1 + ua * (y2 - y1));
|
|
}
|
|
}
|
|
|
|
internal List<Angle> angles;
|
|
|
|
internal void makeAngles( int sides, float startAngle, float stopAngle )
|
|
{
|
|
angles = new List<Angle>();
|
|
double twoPi = System.Math.PI * 2.0;
|
|
float twoPiInv = 1.0f / (float)twoPi;
|
|
|
|
if (sides < 1)
|
|
throw new Exception("number of sides not greater than zero");
|
|
if (stopAngle <= startAngle)
|
|
throw new Exception("stopAngle not greater than startAngle");
|
|
|
|
if ((sides == 3 || sides == 4 || sides == 24))
|
|
{
|
|
startAngle *= twoPiInv;
|
|
stopAngle *= twoPiInv;
|
|
|
|
Angle[] sourceAngles;
|
|
if (sides == 3)
|
|
sourceAngles = angles3;
|
|
else if (sides == 4)
|
|
sourceAngles = angles4;
|
|
else sourceAngles = angles24;
|
|
|
|
int startAngleIndex = (int)(startAngle * sides);
|
|
int endAngleIndex = sourceAngles.Length - 1;
|
|
if (stopAngle < 1.0f)
|
|
endAngleIndex = (int)(stopAngle * sides) + 1;
|
|
if (endAngleIndex == startAngleIndex)
|
|
endAngleIndex++;
|
|
|
|
for (int angleIndex = startAngleIndex; angleIndex < endAngleIndex + 1; angleIndex++)
|
|
angles.Add(sourceAngles[angleIndex]);
|
|
|
|
if (startAngle > 0.0f)
|
|
angles[0] = interpolatePoints(startAngle, angles[0], angles[1]);
|
|
|
|
if (stopAngle < 1.0f)
|
|
{
|
|
int lastAngleIndex = angles.Count - 1;
|
|
angles[lastAngleIndex] = interpolatePoints(stopAngle, angles[lastAngleIndex - 1], angles[lastAngleIndex]);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
double stepSize = twoPi / sides;
|
|
|
|
int startStep = (int)(startAngle / stepSize);
|
|
double angle = stepSize * startStep;
|
|
int step = startStep;
|
|
double stopAngleTest = stopAngle;
|
|
if (stopAngle < twoPi)
|
|
{
|
|
stopAngleTest = stepSize * ((int)(stopAngle / stepSize) + 1);
|
|
if (stopAngleTest < stopAngle)
|
|
stopAngleTest += stepSize;
|
|
if (stopAngleTest > twoPi)
|
|
stopAngleTest = twoPi;
|
|
}
|
|
|
|
while (angle <= stopAngleTest)
|
|
{
|
|
Angle newAngle;
|
|
newAngle.angle = (float)angle;
|
|
newAngle.X = (float)System.Math.Cos(angle);
|
|
newAngle.Y = (float)System.Math.Sin(angle);
|
|
angles.Add(newAngle);
|
|
step += 1;
|
|
angle = stepSize * step;
|
|
}
|
|
|
|
if (startAngle > angles[0].angle)
|
|
{
|
|
Angle newAngle;
|
|
intersection(angles[0].X, angles[0].Y, angles[1].X, angles[1].Y, 0.0f, 0.0f, (float)Math.Cos(startAngle), (float)Math.Sin(startAngle));
|
|
newAngle.angle = startAngle;
|
|
newAngle.X = iX;
|
|
newAngle.Y = iY;
|
|
angles[0] = newAngle;
|
|
}
|
|
|
|
int index = angles.Count - 1;
|
|
if (stopAngle < angles[index].angle)
|
|
{
|
|
Angle newAngle;
|
|
intersection(angles[index - 1].X, angles[index - 1].Y, angles[index].X, angles[index].Y, 0.0f, 0.0f, (float)Math.Cos(stopAngle), (float)Math.Sin(stopAngle));
|
|
newAngle.angle = stopAngle;
|
|
newAngle.X = iX;
|
|
newAngle.Y = iY;
|
|
angles[index] = newAngle;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/// <summary>
|
|
/// generates a profile for extrusion
|
|
/// </summary>
|
|
public class Profile
|
|
{
|
|
private const float twoPi = 2.0f * (float)Math.PI;
|
|
|
|
internal List<Coord> coords;
|
|
internal List<Face> faces;
|
|
|
|
internal Profile()
|
|
{
|
|
this.coords = new List<Coord>();
|
|
this.faces = new List<Face>();
|
|
}
|
|
|
|
public Profile(int sides, float profileStart, float profileEnd, float hollow, int hollowSides, bool createFaces)
|
|
{
|
|
this.coords = new List<Coord>();
|
|
this.faces = new List<Face>();
|
|
Coord center = new Coord(0.0f, 0.0f, 0.0f);
|
|
List<Coord> hollowCoords = new List<Coord>();
|
|
|
|
AngleList angles = new AngleList();
|
|
AngleList hollowAngles = new AngleList();
|
|
|
|
float xScale = 0.5f;
|
|
float yScale = 0.5f;
|
|
if (sides == 4) // corners of a square are sqrt(2) from center
|
|
{
|
|
xScale = 0.707f;
|
|
yScale = 0.707f;
|
|
}
|
|
|
|
float startAngle = profileStart * twoPi;
|
|
float stopAngle = profileEnd * twoPi;
|
|
// float stepSize = twoPi / sides;
|
|
|
|
try { angles.makeAngles(sides, startAngle, stopAngle); }
|
|
catch (Exception ex)
|
|
{
|
|
Console.WriteLine("makeAngles failed: Exception: " + ex.ToString());
|
|
Console.WriteLine("sides: " + sides.ToString() + " startAngle: " + startAngle.ToString() + " stopAngle: " + stopAngle.ToString());
|
|
return;
|
|
}
|
|
|
|
if (hollow > 0.001f)
|
|
{
|
|
if (sides == hollowSides)
|
|
hollowAngles = angles;
|
|
else
|
|
{
|
|
try { hollowAngles.makeAngles(hollowSides, startAngle, stopAngle); }
|
|
catch (Exception ex)
|
|
{
|
|
Console.WriteLine("makeAngles failed: Exception: " + ex.ToString());
|
|
Console.WriteLine("sides: " + sides.ToString() + " startAngle: " + startAngle.ToString() + " stopAngle: " + stopAngle.ToString());
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
else
|
|
this.coords.Add(center);
|
|
|
|
float z = 0.0f;
|
|
|
|
Angle angle;
|
|
Coord newVert = new Coord();
|
|
if (hollow > 0.001f && hollowSides != sides)
|
|
{
|
|
int numHollowAngles = hollowAngles.angles.Count;
|
|
for (int i = 0; i < numHollowAngles; i++)
|
|
{
|
|
angle = hollowAngles.angles[i];
|
|
newVert.X = hollow * xScale * angle.X;
|
|
newVert.Y = hollow * yScale * angle.Y;
|
|
newVert.Z = z;
|
|
|
|
hollowCoords.Add(newVert);
|
|
}
|
|
}
|
|
|
|
int index = 0;
|
|
int numAngles = angles.angles.Count;
|
|
for (int i = 0; i < numAngles; i++)
|
|
{
|
|
angle = angles.angles[i];
|
|
newVert.X = angle.X * xScale;
|
|
newVert.Y = angle.Y * yScale;
|
|
newVert.Z = z;
|
|
this.coords.Add(newVert);
|
|
|
|
if (hollow > 0.0f)
|
|
{
|
|
if (hollowSides == sides)
|
|
{
|
|
newVert.X *= hollow;
|
|
newVert.Y *= hollow;
|
|
newVert.Z = z;
|
|
hollowCoords.Add(newVert);
|
|
}
|
|
}
|
|
else if (createFaces && angle.angle > 0.0001f)
|
|
{
|
|
Face newFace = new Face();
|
|
newFace.v1 = 0;
|
|
newFace.v2 = index;
|
|
newFace.v3 = index + 1;
|
|
this.faces.Add(newFace);
|
|
}
|
|
index += 1;
|
|
}
|
|
|
|
if (hollow > 0.0f)
|
|
{
|
|
hollowCoords.Reverse();
|
|
|
|
if (createFaces)
|
|
{
|
|
int numOuterVerts = this.coords.Count;
|
|
int numHollowVerts = hollowCoords.Count;
|
|
int numTotalVerts = numOuterVerts + numHollowVerts;
|
|
|
|
if (numOuterVerts == numHollowVerts)
|
|
{
|
|
Face newFace = new Face();
|
|
|
|
for (int coordIndex = 0; coordIndex < numOuterVerts - 1; coordIndex++)
|
|
{
|
|
newFace.v1 = coordIndex;
|
|
newFace.v2 = coordIndex + 1;
|
|
newFace.v3 = numTotalVerts - coordIndex - 1;
|
|
this.faces.Add(newFace);
|
|
|
|
newFace.v1 = coordIndex + 1;
|
|
newFace.v2 = numTotalVerts - coordIndex - 2;
|
|
newFace.v3 = numTotalVerts - coordIndex - 1;
|
|
this.faces.Add(newFace);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
if (numOuterVerts < numHollowVerts)
|
|
{
|
|
Face newFace = new Face();
|
|
int j = 0; // j is the index for outer vertices
|
|
int maxJ = numOuterVerts - 1;
|
|
for (int i = 0; i < numHollowVerts; i++) // i is the index for inner vertices
|
|
{
|
|
if (j < maxJ)
|
|
if (angles.angles[j + 1].angle - hollowAngles.angles[i].angle <= hollowAngles.angles[i].angle - angles.angles[j].angle)
|
|
{
|
|
newFace.v1 = numTotalVerts - i - 1;
|
|
newFace.v2 = j;
|
|
newFace.v3 = j + 1;
|
|
|
|
this.faces.Add(newFace);
|
|
j += 1;
|
|
}
|
|
|
|
newFace.v1 = j;
|
|
newFace.v2 = numTotalVerts - i - 2;
|
|
newFace.v3 = numTotalVerts - i - 1;
|
|
|
|
this.faces.Add(newFace);
|
|
}
|
|
}
|
|
else // numHollowVerts < numOuterVerts
|
|
{
|
|
Face newFace = new Face();
|
|
int j = 0; // j is the index for inner vertices
|
|
int maxJ = numHollowVerts - 1;
|
|
for (int i = 0; i < numOuterVerts; i++)
|
|
{
|
|
if (j < maxJ)
|
|
if (hollowAngles.angles[j + 1].angle - angles.angles[i].angle <= angles.angles[i].angle - hollowAngles.angles[j].angle)
|
|
{
|
|
newFace.v1 = i;
|
|
newFace.v2 = numTotalVerts - j - 2;
|
|
newFace.v3 = numTotalVerts - j - 1;
|
|
|
|
this.faces.Add(newFace);
|
|
j += 1;
|
|
}
|
|
|
|
newFace.v1 = numTotalVerts - j - 1;
|
|
newFace.v2 = i;
|
|
newFace.v3 = i + 1;
|
|
|
|
this.faces.Add(newFace);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
this.coords.AddRange(hollowCoords);
|
|
}
|
|
}
|
|
|
|
public Profile Clone()
|
|
{
|
|
return this.Clone(true);
|
|
}
|
|
|
|
public Profile Clone(bool needFaces)
|
|
{
|
|
Profile clone = new Profile();
|
|
|
|
clone.coords.AddRange(this.coords);
|
|
if (needFaces)
|
|
clone.faces.AddRange(this.faces);
|
|
|
|
return clone;
|
|
}
|
|
|
|
public void AddPos(Coord v)
|
|
{
|
|
this.AddPos(v.X, v.Y, v.Z);
|
|
}
|
|
|
|
public void AddPos(float x, float y, float z)
|
|
{
|
|
int i;
|
|
int numVerts = this.coords.Count;
|
|
Coord vert;
|
|
|
|
for (i = 0; i < numVerts; i++)
|
|
{
|
|
vert = this.coords[i];
|
|
vert.X += x;
|
|
vert.Y += y;
|
|
vert.Z += z;
|
|
this.coords[i] = vert;
|
|
}
|
|
}
|
|
|
|
public void AddRot(Quaternion q)
|
|
{
|
|
int i;
|
|
int numVerts = this.coords.Count;
|
|
Coord vert;
|
|
|
|
for (i = 0; i < numVerts; i++)
|
|
{
|
|
vert = this.coords[i];
|
|
Vertex v = new Vertex(vert.X, vert.Y, vert.Z) * q;
|
|
|
|
vert.X = v.X;
|
|
vert.Y = v.Y;
|
|
vert.Z = v.Z;
|
|
this.coords[i] = vert;
|
|
}
|
|
}
|
|
|
|
public void Scale(float x, float y)
|
|
{
|
|
int i;
|
|
int numVerts = this.coords.Count;
|
|
Coord vert;
|
|
|
|
for (i = 0; i < numVerts; i++)
|
|
{
|
|
vert = this.coords[i];
|
|
vert.X *= x;
|
|
vert.Y *= y;
|
|
this.coords[i] = vert;
|
|
}
|
|
}
|
|
|
|
public void FlipNormals()
|
|
{
|
|
int i;
|
|
int numFaces = this.faces.Count;
|
|
Face tmpFace;
|
|
int tmp;
|
|
|
|
for (i = 0; i < numFaces; i++)
|
|
{
|
|
tmpFace = this.faces[i];
|
|
tmp = tmpFace.v3;
|
|
tmpFace.v3 = tmpFace.v1;
|
|
tmpFace.v1 = tmp;
|
|
this.faces[i] = tmpFace;
|
|
}
|
|
}
|
|
|
|
public void AddValue2Faces(int num)
|
|
{
|
|
int numFaces = this.faces.Count;
|
|
Face tmpFace;
|
|
for (int i = 0; i < numFaces; i++)
|
|
{
|
|
tmpFace = this.faces[i];
|
|
tmpFace.v1 += num;
|
|
tmpFace.v2 += num;
|
|
tmpFace.v3 += num;
|
|
this.faces[i] = tmpFace;
|
|
}
|
|
}
|
|
|
|
public void DumpRaw(String path, String name, String title)
|
|
{
|
|
if (path == null)
|
|
return;
|
|
String fileName = name + "_" + title + ".raw";
|
|
String completePath = Path.Combine(path, fileName);
|
|
StreamWriter sw = new StreamWriter(completePath);
|
|
|
|
for (int i = 0; i < this.faces.Count; i++)
|
|
{
|
|
string s = this.coords[this.faces[i].v1].ToString();
|
|
s += " " + this.coords[this.faces[i].v2].ToString();
|
|
s += " " + this.coords[this.faces[i].v3].ToString();
|
|
|
|
sw.WriteLine(s);
|
|
}
|
|
|
|
sw.Close();
|
|
}
|
|
}
|
|
|
|
public class PrimMesh
|
|
{
|
|
private const float twoPi = 2.0f * (float)Math.PI;
|
|
|
|
public List<Coord> coords;
|
|
public List<Face> faces;
|
|
|
|
public int sides = 4;
|
|
public int hollowSides = 4;
|
|
public float profileStart = 0.0f;
|
|
public float profileEnd = 1.0f;
|
|
public float hollow = 0.0f;
|
|
public int twistBegin = 0;
|
|
public int twistEnd = 0;
|
|
public float topShearX = 0.0f;
|
|
public float topShearY = 0.0f;
|
|
public float pathCutBegin = 0.0f;
|
|
public float pathCutEnd = 1.0f;
|
|
public float dimpleBegin = 0.0f;
|
|
public float dimpleEnd = 1.0f;
|
|
public float skew = 0.0f;
|
|
public float holeSizeX = 1.0f; // called pathScaleX in pbs
|
|
public float holeSizeY = 0.25f;
|
|
public float taperX = 0.0f;
|
|
public float taperY = 0.0f;
|
|
public float radius = 0.0f;
|
|
public float revolutions = 1.0f;
|
|
public int stepsPerRevolution = 24;
|
|
|
|
public string ParamsToDisplayString()
|
|
{
|
|
string s = "";
|
|
s += "sides..................: " + this.sides.ToString();
|
|
s += "\nhollowSides..........: " + this.hollowSides.ToString();
|
|
s += "\nprofileStart.........: " + this.profileStart.ToString();
|
|
s += "\nprofileEnd...........: " + this.profileEnd.ToString();
|
|
s += "\nhollow...............: " + this.hollow.ToString();
|
|
s += "\ntwistBegin...........: " + this.twistBegin.ToString();
|
|
s += "\ntwistEnd.............: " + this.twistEnd.ToString();
|
|
s += "\ntopShearX............: " + this.topShearX.ToString();
|
|
s += "\ntopShearY............: " + this.topShearY.ToString();
|
|
s += "\npathCutBegin.........: " + this.pathCutBegin.ToString();
|
|
s += "\npathCutEnd...........: " + this.pathCutEnd.ToString();
|
|
s += "\ndimpleBegin..........: " + this.dimpleBegin.ToString();
|
|
s += "\ndimpleEnd............: " + this.dimpleEnd.ToString();
|
|
s += "\nskew.................: " + this.skew.ToString();
|
|
s += "\nholeSizeX............: " + this.holeSizeX.ToString();
|
|
s += "\nholeSizeY............: " + this.holeSizeY.ToString();
|
|
s += "\ntaperX...............: " + this.taperX.ToString();
|
|
s += "\ntaperY...............: " + this.taperY.ToString();
|
|
s += "\nradius...............: " + this.radius.ToString();
|
|
s += "\nrevolutions..........: " + this.revolutions.ToString();
|
|
s += "\nstepsPerRevolution...: " + this.stepsPerRevolution.ToString();
|
|
|
|
return s;
|
|
}
|
|
|
|
|
|
public PrimMesh(int sides, float profileStart, float profileEnd, float hollow, int hollowSides)
|
|
{
|
|
this.coords = new List<Coord>();
|
|
this.faces = new List<Face>();
|
|
|
|
this.sides = sides;
|
|
this.profileStart = profileStart;
|
|
this.profileEnd = profileEnd;
|
|
this.hollow = hollow;
|
|
this.hollowSides = hollowSides;
|
|
|
|
if (sides < 3)
|
|
this.sides = 3;
|
|
if ( hollowSides < 3)
|
|
this.hollowSides = 3;
|
|
if (profileStart < 0.0f)
|
|
this.profileStart = 0.0f;
|
|
if (profileEnd > 1.0f)
|
|
this.profileEnd = 1.0f;
|
|
if (profileEnd < 0.02f)
|
|
this.profileEnd = 0.02f;
|
|
if (profileStart >= profileEnd)
|
|
this.profileStart = profileEnd - 0.02f;
|
|
if (hollow > 1.0f)
|
|
this.hollow = 1.0f;
|
|
if (hollow < 0.0f)
|
|
this.hollow = 0.0f;
|
|
}
|
|
|
|
public void ExtrudeLinear()
|
|
{
|
|
this.coords = new List<Coord>();
|
|
this.faces = new List<Face>();
|
|
|
|
int step = 0;
|
|
int steps = 1;
|
|
|
|
float length = this.pathCutEnd - this.pathCutBegin;
|
|
|
|
#if VIEWER
|
|
if (this.sides == 3)
|
|
{
|
|
// prisms don't taper well so add some vertical resolution
|
|
// other prims may benefit from this but just do prisms for now
|
|
if (Math.Abs(this.taperX) > 0.01 || Math.Abs(this.taperY) > 0.01)
|
|
steps = (int)(steps * 4.5 * length);
|
|
}
|
|
#endif
|
|
|
|
float twistBegin = this.twistBegin / 360.0f * twoPi;
|
|
float twistEnd = this.twistEnd / 360.0f * twoPi;
|
|
float twistTotal = twistEnd - twistBegin;
|
|
float twistTotalAbs = Math.Abs(twistTotal);
|
|
if (twistTotalAbs > 0.01f)
|
|
steps += (int)(twistTotalAbs * 3.66); // dahlia's magic number
|
|
|
|
float start = -0.5f;
|
|
float stepSize = length / (float)steps;
|
|
float percentOfPathMultiplier = stepSize;
|
|
float xProfileScale = 1.0f;
|
|
float yProfileScale = 1.0f;
|
|
float xOffset = 0.0f;
|
|
float yOffset = 0.0f;
|
|
float zOffset = start;
|
|
float xOffsetStepIncrement = this.topShearX / steps;
|
|
float yOffsetStepIncrement = this.topShearY / steps;
|
|
|
|
float percentOfPath = this.pathCutBegin;
|
|
zOffset += percentOfPath;
|
|
|
|
float hollow = this.hollow;
|
|
|
|
// sanity checks
|
|
float initialProfileRot = 0.0f;
|
|
if (this.sides == 3)
|
|
{
|
|
if (this.hollowSides == 4)
|
|
{
|
|
if (hollow > 0.7f)
|
|
hollow = 0.7f;
|
|
hollow *= 0.707f;
|
|
}
|
|
else hollow *= 0.5f;
|
|
}
|
|
else if (this.sides == 4)
|
|
{
|
|
initialProfileRot = 1.25f * (float)Math.PI;
|
|
if (this.hollowSides != 4)
|
|
hollow *= 0.707f;
|
|
}
|
|
|
|
Profile profile = new Profile(this.sides, this.profileStart, this.profileEnd, hollow, this.hollowSides, true);
|
|
|
|
if (initialProfileRot != 0.0f)
|
|
profile.AddRot(Quaternion.CreateFromAxisAngle(new Vector3(0.0f, 0.0f, 1.0f), initialProfileRot));
|
|
|
|
bool done = false;
|
|
while (!done)
|
|
{
|
|
Profile newLayer = profile.Clone();
|
|
|
|
if (this.taperX == 0.0f)
|
|
xProfileScale = 1.0f;
|
|
else if (this.taperX > 0.0f)
|
|
xProfileScale = 1.0f - percentOfPath * this.taperX;
|
|
else xProfileScale = 1.0f + (1.0f - percentOfPath) * this.taperX;
|
|
|
|
if (this.taperY == 0.0f)
|
|
yProfileScale = 1.0f;
|
|
else if (this.taperY > 0.0f)
|
|
yProfileScale = 1.0f - percentOfPath * this.taperY;
|
|
else yProfileScale = 1.0f + (1.0f - percentOfPath) * this.taperY;
|
|
|
|
if (xProfileScale != 1.0f || yProfileScale != 1.0f)
|
|
newLayer.Scale(xProfileScale, yProfileScale);
|
|
|
|
float twist = twistBegin + twistTotal * percentOfPath;
|
|
if (twist != 0.0f)
|
|
newLayer.AddRot(Quaternion.CreateFromAxisAngle(new Vector3(0.0f, 0.0f, 1.0f), twist));
|
|
|
|
newLayer.AddPos(xOffset, yOffset, zOffset);
|
|
|
|
if (step == 0)
|
|
newLayer.FlipNormals();
|
|
|
|
// append this layer
|
|
|
|
int coordsLen = this.coords.Count;
|
|
newLayer.AddValue2Faces(coordsLen);
|
|
|
|
this.coords.AddRange(newLayer.coords);
|
|
|
|
if (percentOfPath <= this.pathCutBegin || percentOfPath >= this.pathCutEnd)
|
|
this.faces.AddRange(newLayer.faces);
|
|
|
|
// fill faces between layers
|
|
|
|
int numVerts = newLayer.coords.Count;
|
|
Face newFace = new Face();
|
|
if (step > 0)
|
|
{
|
|
for (int i = coordsLen; i < this.coords.Count - 1; i++)
|
|
{
|
|
newFace.v1 = i;
|
|
newFace.v2 = i - numVerts;
|
|
newFace.v3 = i - numVerts + 1;
|
|
this.faces.Add(newFace);
|
|
|
|
newFace.v2 = i - numVerts + 1;
|
|
newFace.v3 = i + 1;
|
|
this.faces.Add(newFace);
|
|
}
|
|
|
|
newFace.v1 = coordsLen - 1;
|
|
newFace.v2 = coordsLen - numVerts;
|
|
newFace.v3 = coordsLen;
|
|
this.faces.Add(newFace);
|
|
|
|
newFace.v1 = coordsLen + numVerts - 1;
|
|
newFace.v2 = coordsLen - 1;
|
|
newFace.v3 = coordsLen;
|
|
this.faces.Add(newFace);
|
|
}
|
|
|
|
// calc the step for the next iteration of the loop
|
|
|
|
if (step < steps)
|
|
{
|
|
step += 1;
|
|
percentOfPath += percentOfPathMultiplier;
|
|
xOffset += xOffsetStepIncrement;
|
|
yOffset += yOffsetStepIncrement;
|
|
zOffset += stepSize;
|
|
if (percentOfPath > this.pathCutEnd)
|
|
done = true;
|
|
}
|
|
else done = true;
|
|
}
|
|
}
|
|
|
|
public void ExtrudeCircular()
|
|
{
|
|
this.coords = new List<Coord>();
|
|
this.faces = new List<Face>();
|
|
|
|
int step = 0;
|
|
int steps = 24;
|
|
|
|
float twistBegin = this.twistBegin / 360.0f * twoPi;
|
|
float twistEnd = this.twistEnd / 360.0f * twoPi;
|
|
float twistTotal = twistEnd - twistBegin;
|
|
|
|
// if the profile has a lot of twist, add more layers otherwise the layers may overlap
|
|
// and the resulting mesh may be quite inaccurate. This method is arbitrary and doesn't
|
|
// accurately match the viewer
|
|
float twistTotalAbs = Math.Abs(twistTotal);
|
|
if (twistTotalAbs > 0.01f)
|
|
{
|
|
if (twistTotalAbs > Math.PI * 1.5f)
|
|
steps *= 2;
|
|
if (twistTotalAbs > Math.PI * 3.0f)
|
|
steps *= 2;
|
|
}
|
|
|
|
float yPathScale = this.holeSizeY * 0.5f;
|
|
float pathLength = this.pathCutEnd - this.pathCutBegin;
|
|
float totalSkew = this.skew * 2.0f * pathLength;
|
|
float skewStart = this.pathCutBegin * 2.0f * this.skew - this.skew;
|
|
float xOffsetTopShearXFactor = this.topShearX * (0.25f + 0.5f * (0.5f - this.holeSizeY));
|
|
float yShearCompensation = 1.0f + Math.Abs(this.topShearY) * 0.25f;
|
|
|
|
// It's not quite clear what pushY (Y top shear) does, but subtracting it from the start and end
|
|
// angles appears to approximate it's effects on path cut. Likewise, adding it to the angle used
|
|
// to calculate the sine for generating the path radius appears to approximate it's effects there
|
|
// too, but there are some subtle differences in the radius which are noticeable as the prim size
|
|
// increases and it may affect megaprims quite a bit. The effect of the Y top shear parameter on
|
|
// the meshes generated with this technique appear nearly identical in shape to the same prims when
|
|
// displayed by the viewer.
|
|
|
|
float startAngle = (twoPi * this.pathCutBegin * this.revolutions) - this.topShearY * 0.9f;
|
|
float endAngle = (twoPi * this.pathCutEnd * this.revolutions) - this.topShearY * 0.9f;
|
|
float stepSize = twoPi / this.stepsPerRevolution;
|
|
|
|
step = (int)(startAngle / stepSize);
|
|
int firstStep = step;
|
|
float angle = startAngle;
|
|
float hollow = this.hollow;
|
|
|
|
// sanity checks
|
|
float initialProfileRot = 0.0f;
|
|
if (this.sides == 3)
|
|
{
|
|
initialProfileRot = (float)Math.PI;
|
|
if (this.hollowSides == 4)
|
|
{
|
|
if (hollow > 0.7f)
|
|
hollow = 0.7f;
|
|
hollow *= 0.707f;
|
|
}
|
|
else hollow *= 0.5f;
|
|
}
|
|
else if (this.sides == 4)
|
|
{
|
|
initialProfileRot = 0.25f * (float)Math.PI;
|
|
if (this.hollowSides != 4)
|
|
hollow *= 0.707f;
|
|
}
|
|
else if (this.sides > 4)
|
|
{
|
|
initialProfileRot = (float)Math.PI;
|
|
if (this.hollowSides == 4)
|
|
{
|
|
if (hollow > 0.7f)
|
|
hollow = 0.7f;
|
|
hollow /= 0.7f;
|
|
}
|
|
}
|
|
|
|
bool needEndFaces = false;
|
|
if (this.pathCutBegin != 0.0 || this.pathCutEnd != 1.0)
|
|
needEndFaces = true;
|
|
else if (this.taperX != 0.0 || this.taperY != 0.0)
|
|
needEndFaces = true;
|
|
else if (this.skew != 0.0)
|
|
needEndFaces = true;
|
|
else if (twistTotal != 0.0)
|
|
needEndFaces = true;
|
|
|
|
Profile profile = new Profile(this.sides, this.profileStart, this.profileEnd, hollow, this.hollowSides, needEndFaces);
|
|
|
|
if (initialProfileRot != 0.0f)
|
|
profile.AddRot(Quaternion.CreateFromAxisAngle(new Vector3(0.0f, 0.0f, 1.0f), initialProfileRot));
|
|
|
|
bool done = false;
|
|
while (!done) // loop through the length of the path and add the layers
|
|
{
|
|
bool isEndLayer = false;
|
|
if (angle == startAngle || angle >= endAngle)
|
|
isEndLayer = true;
|
|
|
|
Profile newLayer = profile.Clone(isEndLayer && needEndFaces);
|
|
|
|
float xProfileScale = (1.0f - Math.Abs(this.skew)) * this.holeSizeX;
|
|
float yProfileScale = this.holeSizeY;
|
|
|
|
float percentOfPath = angle / (twoPi * this.revolutions);
|
|
float percentOfAngles = (angle - startAngle) / (endAngle - startAngle);
|
|
|
|
if (this.taperX > 0.01f)
|
|
xProfileScale *= 1.0f - percentOfPath * this.taperX;
|
|
else if (this.taperX < -0.01f)
|
|
xProfileScale *= 1.0f + (1.0f - percentOfPath) * this.taperX;
|
|
|
|
if (this.taperY > 0.01f)
|
|
yProfileScale *= 1.0f - percentOfPath * this.taperY;
|
|
else if (this.taperY < -0.01f)
|
|
yProfileScale *= 1.0f + (1.0f - percentOfPath) * this.taperY;
|
|
|
|
if (xProfileScale != 1.0f || yProfileScale != 1.0f)
|
|
newLayer.Scale(xProfileScale, yProfileScale);
|
|
|
|
float radiusScale = 1.0f;
|
|
if (this.radius > 0.001f)
|
|
radiusScale = 1.0f - this.radius * percentOfPath;
|
|
else if (this.radius < 0.001f)
|
|
radiusScale = 1.0f + this.radius * (1.0f - percentOfPath);
|
|
|
|
float twist = twistBegin + twistTotal * percentOfPath;
|
|
|
|
float xOffset = 0.5f * (skewStart + totalSkew * percentOfAngles);
|
|
xOffset += (float)Math.Sin(angle) * xOffsetTopShearXFactor;
|
|
|
|
float yOffset = yShearCompensation * (float)Math.Cos(angle) * (0.5f - yPathScale) * radiusScale;
|
|
|
|
float zOffset = (float)Math.Sin(angle + this.topShearY) * (0.5f - yPathScale) * radiusScale;
|
|
|
|
// next apply twist rotation to the profile layer
|
|
if (twistTotal != 0.0f || twistBegin != 0.0f)
|
|
newLayer.AddRot(Quaternion.CreateFromAxisAngle(new Vector3(0.0f, 0.0f, 1.0f), twist));
|
|
|
|
// now orient the rotation of the profile layer relative to it's position on the path
|
|
// adding taperY to the angle used to generate the quat appears to approximate the viewer
|
|
//newLayer.AddRot(new Quaternion(new Vertex(1.0f, 0.0f, 0.0f), angle + this.topShearY * 0.9f));
|
|
newLayer.AddRot(Quaternion.CreateFromAxisAngle(new Vector3(1.0f, 0.0f, 0.0f), angle + this.topShearY));
|
|
newLayer.AddPos(xOffset, yOffset, zOffset);
|
|
|
|
if (angle == startAngle)
|
|
newLayer.FlipNormals();
|
|
|
|
// append the layer and fill in the sides
|
|
|
|
int coordsLen = this.coords.Count;
|
|
newLayer.AddValue2Faces(coordsLen);
|
|
|
|
this.coords.AddRange(newLayer.coords);
|
|
|
|
if (isEndLayer)
|
|
this.faces.AddRange(newLayer.faces);
|
|
|
|
// fill faces between layers
|
|
|
|
int numVerts = newLayer.coords.Count;
|
|
Face newFace = new Face();
|
|
if (step > firstStep)
|
|
{
|
|
for (int i = coordsLen; i < this.coords.Count - 1; i++)
|
|
{
|
|
newFace.v1 = i;
|
|
newFace.v2 = i - numVerts;
|
|
newFace.v3 = i - numVerts + 1;
|
|
this.faces.Add(newFace);
|
|
|
|
newFace.v2 = i - numVerts + 1;
|
|
newFace.v3 = i + 1;
|
|
this.faces.Add(newFace);
|
|
}
|
|
|
|
newFace.v1 = coordsLen - 1;
|
|
newFace.v2 = coordsLen - numVerts;
|
|
newFace.v3 = coordsLen;
|
|
this.faces.Add(newFace);
|
|
|
|
newFace.v1 = coordsLen + numVerts - 1;
|
|
newFace.v2 = coordsLen - 1;
|
|
newFace.v3 = coordsLen;
|
|
this.faces.Add(newFace);
|
|
}
|
|
|
|
// calculate terms for next iteration
|
|
// calculate the angle for the next iteration of the loop
|
|
|
|
if (angle >= endAngle)
|
|
done = true;
|
|
else
|
|
{
|
|
step += 1;
|
|
angle = stepSize * step;
|
|
if (angle > endAngle)
|
|
angle = endAngle;
|
|
}
|
|
}
|
|
}
|
|
|
|
public void AddPos(float x, float y, float z)
|
|
{
|
|
int i;
|
|
int numVerts = this.coords.Count;
|
|
Coord vert;
|
|
|
|
for (i = 0; i < numVerts; i++)
|
|
{
|
|
vert = this.coords[i];
|
|
vert.X += x;
|
|
vert.Y += y;
|
|
vert.Z += z;
|
|
this.coords[i] = vert;
|
|
}
|
|
}
|
|
|
|
public void AddRot(Quaternion q)
|
|
{
|
|
int i;
|
|
int numVerts = this.coords.Count;
|
|
Coord vert;
|
|
|
|
for (i = 0; i < numVerts; i++)
|
|
{
|
|
vert = this.coords[i];
|
|
Vertex v = new Vertex(vert.X, vert.Y, vert.Z) * q;
|
|
|
|
vert.X = v.X;
|
|
vert.Y = v.Y;
|
|
vert.Z = v.Z;
|
|
this.coords[i] = vert;
|
|
}
|
|
}
|
|
|
|
public void Scale(float x, float y, float z)
|
|
{
|
|
int i;
|
|
int numVerts = this.coords.Count;
|
|
Coord vert;
|
|
|
|
for (i = 0; i < numVerts; i++)
|
|
{
|
|
vert = this.coords[i];
|
|
vert.X *= x;
|
|
vert.Y *= y;
|
|
vert.Z *= z;
|
|
this.coords[i] = vert;
|
|
}
|
|
}
|
|
|
|
public void DumpRaw(String path, String name, String title)
|
|
{
|
|
if (path == null)
|
|
return;
|
|
String fileName = name + "_" + title + ".raw";
|
|
String completePath = Path.Combine(path, fileName);
|
|
StreamWriter sw = new StreamWriter(completePath);
|
|
|
|
for (int i = 0; i < this.faces.Count; i++)
|
|
{
|
|
string s = this.coords[this.faces[i].v1].ToString();
|
|
s += " " + this.coords[this.faces[i].v2].ToString();
|
|
s += " " + this.coords[this.faces[i].v3].ToString();
|
|
|
|
sw.WriteLine(s);
|
|
}
|
|
|
|
sw.Close();
|
|
}
|
|
}
|
|
}
|