private double[] GetDirection(IModelDoc2 model, object inputObj)
{
if (inputObj is IFace2)
{
ISurface surf = (inputObj as IFace2).GetSurface() as ISurface;
if (surf.IsCylinder())
{
double[] cylParams = surf.CylinderParams as double[];
return(new double[] { cylParams[3], cylParams[4], cylParams[5] });
}
}
else if (inputObj is IFeature)
{
IRefPlane refPlane = (inputObj as IFeature).GetSpecificFeature2() as IRefPlane;
if (refPlane != null)
{
IMathUtility mathUtils = swApp.GetMathUtility() as IMathUtility;
IMathVector vec = mathUtils.CreateVector(new double[] { 0, 0, 1 }) as IMathVector;
vec = vec.MultiplyTransform(refPlane.Transform) as IMathVector;
return(vec.ArrayData as double[]);
}
}
throw new NullReferenceException("Failed to find the direction. Please select cylindrical face or plane");
}
public double[] TransformVector(double[] dir, IMathTransform transform)
{
IMathVector vec = m_MathUtils.CreateVector(dir) as IMathVector;
vec = vec.MultiplyTransform(transform) as IMathVector;
return(vec.ArrayData as double[]);
}
public Vector TransformVector(Vector vector, TransformationMaxtrix transform)
{
IMathVector vec = m_MathUtils.CreateVector(vector.ToArray()) as IMathVector;
var swTransform = m_MathUtils.CreateTransFormTransformationMaxtrix(transform);
vec = vec.MultiplyTransform(swTransform) as IMathVector;
return(new Vector(vec.ArrayData as double[]));
}
private void ExportToStl(string filePath, float[] tessTriangs, float[] tessNorms, double[] transformMatrix)
{
IMathUtility mathUtils = swApp.IGetMathUtility();
IMathTransform transform = (mathUtils.CreateTransform(transformMatrix) as IMathTransform).IInverse();
using (FileStream fileStream = File.Create(filePath))
{
using (BinaryWriter writer = new BinaryWriter(fileStream))
{
byte[] header = new byte[80];
writer.Write(header);
uint triangsCount = (uint)tessTriangs.Length / 9;
writer.Write(triangsCount);
for (uint i = 0; i < triangsCount; i++)
{
float normalX = tessNorms[i * 9];
float normalY = tessNorms[i * 9 + 1];
float normalZ = tessNorms[i * 9 + 2];
IMathVector mathVec = mathUtils.CreateVector(
new double[] { normalX, normalY, normalZ }) as IMathVector;
mathVec = mathVec.MultiplyTransform(transform) as IMathVector;
double[] vec = mathVec.ArrayData as double[];
writer.Write((float)vec[0]);
writer.Write((float)vec[1]);
writer.Write((float)vec[2]);
for (uint j = 0; j < 3; j++)
{
float vertX = tessTriangs[i * 9 + j * 3];
float vertY = tessTriangs[i * 9 + j * 3 + 1];
float vertZ = tessTriangs[i * 9 + j * 3 + 2];
IMathPoint mathPt = mathUtils.CreatePoint(
new double[] { vertX, vertY, vertZ }) as IMathPoint;
mathPt = mathPt.MultiplyTransform(transform) as IMathPoint;
double[] pt = mathPt.ArrayData as double[];
writer.Write((float)pt[0]);
writer.Write((float)pt[1]);
writer.Write((float)pt[2]);
}
ushort atts = 0;
writer.Write(atts);
}
}
}
}
public static MathVector MultiplyTransformTs(this IMathVector v, IMathTransform t)
{
return((MathVector)v.MultiplyTransform(t));
}
