private void calcNormal(List <int>[] idc, ref PointCloud MyCloud, ref int count, int i)
{
List <Point3d> normalPts = new List <Point3d>();
normalPts.Add(GlobalCloud[i].Location);
List <int> ids = idc[i];
if (ids.Count >= 3)
{
for (int j = 0; j < ids.Count; j++)
{
Point3d nPt = GlobalCloud[ids[j]].Location;
normalPts.Add(nPt);
}
//Get not-oriented normal from Z-Axis of best fit plane to NormalPoints.
Plane normalPln = new Plane();
Plane.FitPlaneToPoints(normalPts, out normalPln);
Vector3d notOriNormal = normalPln.ZAxis;
//Orient not-oriented NormalVector according to the guiding vector.
Vector3d guideVector = new Vector3d();
if (insV_GuideStyle == true)
{
guideVector = insV_GuideVector;
}
else if (insV_GuideStyle == false)
{
guideVector = Point3d.Subtract(GlobalCloud[i].Location, new Point3d(insV_GuideVector));
}
guideVector.Unitize();
Vector3d normalVector = new Vector3d();
double vecAngle = Vector3d.VectorAngle(notOriNormal, guideVector);
if (vecAngle < Math.PI / 2)
{
normalVector = notOriNormal;
}
else
{
normalVector = notOriNormal;
normalVector.Reverse();
}
//Add normal to Cloud.
Cloud_Utils.AddItem_FromOtherCloud(ref MyCloud, GlobalCloud, i);
MyCloud[count].Normal = normalVector;
if (insV_Colorize)
{
MyCloud[count].Color = KDTreeLib.normalColors(1, normalVector, GlobalCloud[i].Color);
}
count += 1;
}
}
/// <summary>
/// Parallel Computing Setup for Code to Execute.
/// </summary>
/// <param name="pointCloud">ByRef PointCloud to Execute Code on.</param>
/// <returns></returns>
public override bool Execute(ref PointCloud pointCloud)
{
//Set Global Variables
LastPercentReported = 0;
PointCounter = 0;
NewCloud = new PointCloud();
CloudPieces = null;
CloudPieces = new PointCloud[ProcCount];
DictPieces = new object[ProcCount];
GlobalCloud = pointCloud;
// Setup the cancellation mechanism.
po.CancellationToken = cts.Token;
//Create Partitions for multithreading.
var rangePartitioner = System.Collections.Concurrent.Partitioner.Create(0, GlobalCloud.Count, (int)Math.Ceiling((double)GlobalCloud.Count / ProcCount));
Dict_Utils.CastDictionary_ToArrayDouble(ref GlobalCloud);
//Run MultiThreaded Loop.
Parallel.ForEach(rangePartitioner, po, (rng, loopState) =>
{
//Initialize Local Variables.
/// Get Index for Processor to be able to merge clouds in ProcesserIndex order in the end.
int MyIndex = (int)(rng.Item1 / Math.Ceiling(((double)GlobalCloud.Count / ProcCount)));
/// Initialize Partial PointCloud
PointCloud MyCloud = new PointCloud();
/// Get Total Count Fraction to calculate Operation Percentage.
double totc = (double)1 / GlobalCloud.Count;
/// Initialize Partial Dictionary Lists
List <double>[] MyDict = new List <double> [GlobalCloud.UserDictionary.Count];
//Get Dictionary Values from PointCloud
List <double[]> GlobalDict = new List <double[]>();
GlobalDict.Clear();
if (GlobalCloud.UserDictionary.Count > 0)
{
Dict_Utils.Initialize_Dictionary(ref GlobalDict, ref MyDict, GlobalCloud);
//Loop over individual RangePartitions per processor.
for (int i = rng.Item1; i < rng.Item2; i++)
{
//Operation Percentage Report
///Safe Counter Increment.
Interlocked.Increment(ref PointCounter);
///Calculate and Report Percentage.
if (LastPercentReported < ((PointCounter * totc) * 100))
{
LastPercentReported = (int)(5 * Math.Ceiling((double)(PointCounter * totc) * 20));
this.ReportPercent = LastPercentReported;
}
//
if (insV_InsideBool)
{
for (int j = 0; j <= insV_Box.Count - 1; j += 1)
{
PointCloudItem GlobalCloudItem = GlobalCloud[i];
if (Math_Utils.IsInBox(GlobalCloudItem.Location, insV_Box[j]))
{
Cloud_Utils.AddItem_FromOtherCloud(ref MyCloud, GlobalCloud, i);
Dict_Utils.AddItem_FromGlobalDict(ref MyDict, GlobalDict, i);
break; // TODO: might not be correct. Was : Exit For
}
}
}
else
{
List <Boolean> CropBools = new List <Boolean>();
PointCloudItem GlobalCloudItem = GlobalCloud[i];
for (int j = 0; j <= insV_Box.Count - 1; j += 1)
{
CropBools.Add(Math_Utils.IsInBox(GlobalCloudItem.Location, insV_Box[j]));
}
bool Crop = !CropBools.Any(x => x == true);
if (Crop)
{
Cloud_Utils.AddItem_FromOtherCloud(ref MyCloud, GlobalCloud, i);
Dict_Utils.AddItem_FromGlobalDict(ref MyDict, GlobalDict, i);
}
}
}
}
else
{
//Loop over individual RangePartitions per processor.
for (int i = rng.Item1; i < rng.Item2; i++)
{
//Operation Percentage Report
///Safe Counter Increment.
Interlocked.Increment(ref PointCounter);
///Calculate and Report Percentage.
if (LastPercentReported < ((PointCounter * totc) * 100))
{
LastPercentReported = (int)(5 * Math.Ceiling((double)(PointCounter * totc) * 20));
this.ReportPercent = LastPercentReported;
}
//
if (insV_InsideBool)
{
for (int j = 0; j <= insV_Box.Count - 1; j += 1)
{
PointCloudItem GlobalCloudItem = GlobalCloud[i];
if (Math_Utils.IsInBox(GlobalCloudItem.Location, insV_Box[j]))
{
Cloud_Utils.AddItem_FromOtherCloud(ref MyCloud, GlobalCloud, i);
break; // TODO: might not be correct. Was : Exit For
}
}
}
else
{
List <Boolean> CropBools = new List <Boolean>();
PointCloudItem GlobalCloudItem = GlobalCloud[i];
for (int j = 0; j <= insV_Box.Count - 1; j += 1)
{
CropBools.Add(Math_Utils.IsInBox(GlobalCloudItem.Location, insV_Box[j]));
}
bool Crop = !CropBools.Any(x => x == true);
if (Crop)
{
Cloud_Utils.AddItem_FromOtherCloud(ref MyCloud, GlobalCloud, i);
}
}
}
}
//Set DictPieces.
if (GlobalCloud.UserDictionary.Count > 0)
{
DictPieces[(int)MyIndex] = MyDict;
}
//Add MyCloud to CloudPieces at ProcesserIndex.
CloudPieces[(int)MyIndex] = MyCloud;
//Enable Parrallel Computing Cancellation
po.CancellationToken.ThrowIfCancellationRequested();
}
);
//Merge PointCloud Pieces into One PointCloud.
Cloud_Utils.MergeClouds(ref NewCloud, CloudPieces);
if (GlobalCloud.UserDictionary.Count > 0)
{
List <double>[] NewDict = new List <double> [GlobalCloud.UserDictionary.Count];
Dict_Utils.Merge_DictPieces(ref NewDict, DictPieces);
Dict_Utils.SetUserDict_FromDictLists(ref NewCloud, NewDict, GlobalCloud.UserDictionary.Keys);
}
//Dispose of Global Clouds.
GlobalCloud.Dispose();
pointCloud.Dispose();
//Set OutputCloud
pointCloud = (PointCloud)NewCloud.Duplicate();
//Dispose of PointCloud Pieces and NewCloud.
CloudPieces = null;
DictPieces = null;
NewCloud.Dispose();
//Return True on Finish
return(true);
}
/// <summary>
/// Parallel Computing Setup for Code to Execute.
/// </summary>
/// <param name="pointCloud">ByRef PointCloud to Execute Code on.</param>
/// <returns></returns>
public override bool Execute(ref PointCloud pointCloud)
{
//Set Global Variables
LastPercentReported = 0;
PointCounter = 0;
if (insV_KDTree == null)
{
tree = KDTreeLib.ConstructKDTree(pointCloud);
}
else
{
tree = insV_KDTree;
}
Dict_Utils.CastDictionary_ToArrayDouble(ref pointCloud);
GlobalCloud = pointCloud;
NewCloud = new PointCloud();
CloudPieces = null;
CloudPieces = new PointCloud[ProcCount];
DictPieces = new object[ProcCount];
pts = pointCloud.GetPoints().ToList();
// Setup the cancellation mechanism.
po.CancellationToken = cts.Token;
//Create Partitions for multithreading.
var rangePartitioner = System.Collections.Concurrent.Partitioner.Create(0, GlobalCloud.Count, (int)Math.Ceiling((double)GlobalCloud.Count / ProcCount));
Dict_Utils.CastDictionary_ToArrayDouble(ref GlobalCloud);
//Search for NearestNeighbors per point in PointCloud. Gets the indices in the Cloud for the neighbors to each Point.
List <double> NRange = new List <double> {
double.MaxValue
};
List <int>[] idc = KDTreeLib.NearestNeighborSearch(tree, pts, NRange, insV_NumN);
//Run MultiThreaded Loop.
Parallel.ForEach(rangePartitioner, po, (rng, loopState) =>
{
//Initialize Local Variables.
/// Get Index for Processor to be able to merge clouds in ProcesserIndex order in the end.
int MyIndex = (int)(rng.Item1 / Math.Ceiling(((double)GlobalCloud.Count / ProcCount)));
/// Initialize Partial PointCloud
PointCloud MyCloud = new PointCloud();
/// Get Total Count Fraction to calculate Operation Percentage.
double totc = (double)1 / GlobalCloud.Count;
int count = 0;
if (GlobalCloud.UserDictionary.Count > 0)
{
/// Initialize Partial Dictionary Lists
List <double>[] MyDict = new List <double> [GlobalCloud.UserDictionary.Count];
//Get Dictionary Values from PointCloud
List <double[]> GlobalDict = new List <double[]>();
GlobalDict.Clear();
Dict_Utils.Initialize_Dictionary(ref GlobalDict, ref MyDict, GlobalCloud);
//Loop over individual RangePartitions per processor.
for (int i = rng.Item1; i < rng.Item2; i++)
{
//Operation Percentage Report
///Safe Counter Increment.
Interlocked.Increment(ref PointCounter);
///Calculate and Report Percentage.
if (LastPercentReported < ((PointCounter * totc) * 100))
{
LastPercentReported = (int)(5 * Math.Ceiling((double)(PointCounter * totc) * 20));
this.ReportPercent = LastPercentReported;
}
calcNormal(idc, ref MyCloud, ref count, i);
Dict_Utils.AddItem_FromGlobalDict(ref MyDict, GlobalDict, i);
}
//Add MyCloud to CloudPieces at ProcesserIndex.
CloudPieces[(int)MyIndex] = MyCloud;
//Set DictPieces.
DictPieces[(int)MyIndex] = MyDict;
}
else
{
//Loop over individual RangePartitions per processor.
for (int i = rng.Item1; i < rng.Item2; i++)
{
//Operation Percentage Report
///Safe Counter Increment.
Interlocked.Increment(ref PointCounter);
///Calculate and Report Percentage.
if (LastPercentReported < ((PointCounter * totc) * 100))
{
LastPercentReported = (int)(5 * Math.Ceiling((double)(PointCounter * totc) * 20));
this.ReportPercent = LastPercentReported;
}
calcNormal(idc, ref MyCloud, ref count, i);
}
//Add MyCloud to CloudPieces at ProcesserIndex.
CloudPieces[(int)MyIndex] = MyCloud;
}
//Enable Parrallel Computing Cancellation
po.CancellationToken.ThrowIfCancellationRequested();
}
);
//Merge PointCloud Pieces into One PointCloud.
Cloud_Utils.MergeClouds(ref NewCloud, CloudPieces);
if (GlobalCloud.UserDictionary.Count > 0)
{
List <double>[] NewDict = new List <double> [GlobalCloud.UserDictionary.Count];
Dict_Utils.Merge_DictPieces(ref NewDict, DictPieces);
Dict_Utils.SetUserDict_FromDictLists(ref NewCloud, NewDict, GlobalCloud.UserDictionary.Keys);
}
//Dispose of Global Clouds.
GlobalCloud.Dispose();
pointCloud.Dispose();
/*
* //Colorize
* if (insV_Colorize)
* {
* List<double> colorValues = Color_Utils.ColorValues_Std_pos(NewCloud, insV_Key);
* List<Color> Colors = Color_Utils.ColorGradient_Std_GtoR();
*
* Instruction.Instr_Dict_Color col = new Instruction.Instr_Dict_Color(insV_Key, colorValues, Colors, -1, 0.00);
* Boolean ColResult = col.Execute(ref NewCloud);
*
* //Set ColorGradient UserData
* Color_Utils.Set_ColorGradient_Dict(ref NewCloud, Colors, colorValues);
* }
*/
pointCloud = (PointCloud)NewCloud.Duplicate();
//Dispose of PointCloud Pieces and NewCloud.
GlobalCloud.Dispose();
NewCloud.Dispose();
//Return True on Finish
return(true);
}
/// <summary>
///
/// </summary>
/// <param name="PointCloud"></param>
/// <param name="Message"></param>
/// <returns></returns>
public override bool Execute(ref PointCloud pointCloud)
{
#region - Initialize Execution
//Set Global Variables
LastPercentReported = 0;
PointCounter = 0;
NewCloud = new PointCloud();
CloudPieces = null;
CloudPieces = new PointCloud[ProcCount];
GlobalCloud = pointCloud;
// Setup the cancellation mechanism.
po.CancellationToken = cts.Token;
//Create Partitions for multithreading.
var rangePartitioner = System.Collections.Concurrent.Partitioner.Create(0, GlobalCloud.Count, (int)Math.Ceiling((double)GlobalCloud.Count / ProcCount));
Dict_Utils.CastDictionary_ToArrayDouble(ref GlobalCloud);
////
//Initialize ColorGradient
Interval Itv = new Interval();
Bitmap bmp = new Bitmap(1000, 1);
Rectangle rect = new Rectangle(0, 0, bmp.Width, bmp.Height);
System.Drawing.Drawing2D.ColorBlend cb = new System.Drawing.Drawing2D.ColorBlend();
float[] pos = new float[insV_Colors.Count];
for (int i = 0; i <= pos.Length - 1; i += 1)
{
pos[i] = (float)insV_Values[i];
}
Color[] colors = insV_Colors.ToArray();
Array.Sort(pos, colors);
Array.Sort(pos, pos);
float[] normpos = new float[insV_Colors.Count];
Itv = new Interval(pos[0], pos[pos.Length - 1]);
for (int i = 0; i <= normpos.Length - 1; i += 1)
{
normpos[i] = (float)Itv.NormalizedParameterAt(pos[i]);
}
cb.Positions = normpos;
cb.Colors = colors;
System.Drawing.Drawing2D.LinearGradientBrush lin = new System.Drawing.Drawing2D.LinearGradientBrush(rect, Color.Black, Color.Black, 0, false);
lin.LinearColors = colors;
lin.InterpolationColors = cb;
ColVal = null;
ColVal = new Color[bmp.Width];
int counter = 0;
using (Graphics g = Graphics.FromImage(bmp))
{
g.FillRectangle(lin, rect);
for (int i = 0; i <= bmp.Width - 1; i += 1)
{
Color col = bmp.GetPixel(i, 0);
ColVal[counter] = col;
counter += 1;
}
}
////
//Get Dictionary Values from PointCloud
List <double> DictVal = new List <double>();
DictVal.AddRange((double[])GlobalCloud.UserDictionary[insV_Key]);
//Get idx to multiply with for normalized values.
int idx = ColVal.Length - 1;
//Run MultiThreaded Loop.
Parallel.ForEach(rangePartitioner, po, (rng, loopState) =>
{
//Initialize Local Variables.
/// Get Index for Processor to be able to merge clouds in ProcesserIndex order in the end.
int MyIndex = (int)(rng.Item1 / Math.Ceiling(((double)GlobalCloud.Count / ProcCount)));
/// Initialize Partial PointCloud
PointCloud MyCloud = new PointCloud();
/// Get Total Count Fraction to calculate Operation Percentage.
double totc = (double)1 / GlobalCloud.Count;
//Loop over individual RangePartitions per processor.
for (int i = rng.Item1; i < rng.Item2; i++)
{
//Operation Percentage Report
///Safe Counter Increment.
Interlocked.Increment(ref PointCounter);
///Calculate and Report Percentage.
if (LastPercentReported < ((PointCounter * totc) * 100))
{
LastPercentReported = (int)(5 * Math.Ceiling((double)(PointCounter * totc) * 20));
this.ReportPercent = LastPercentReported;
}
#endregion - End of Initialize Execution
#region - Code to Process on PointCloud.
double thisnorm = new double();
if (insV_Step <= 0.0)
{
thisnorm = Itv.NormalizedParameterAt(DictVal[i]);
}
else
{
thisnorm = Itv.NormalizedParameterAt((Math.Floor((DictVal[i] - Itv[0]) / insV_Step) * insV_Step) + Itv[0]);
}
Color col = new Color();
if (thisnorm < (0.0000000))
{
col = ColVal.First();
}
else if (thisnorm > (1.0000000)) //+ Rhino.RhinoDoc.ActiveDoc.ModelAbsoluteTolerance)
{
col = ColVal.Last();
}
else
{
col = ColVal[(int)(thisnorm * idx)];
}
if (insV_ColPct >= 0.0)
{
col = Color_Utils.Blend(GlobalCloud[i].Color, col, insV_ColPct);
}
MyCloud.Add(GlobalCloud[i].Location, col);
#endregion - End of Code to Process on PointCloud.
#region - Finalize Execution
}
//Add MyCloud to CloudPieces at ProcesserIndex.
CloudPieces[(int)MyIndex] = MyCloud;
//Enable Parrallel Computing Cancellation
po.CancellationToken.ThrowIfCancellationRequested();
}
);
//Merge PointCloud Pieces into One PointCloud.
Cloud_Utils.MergeClouds(ref NewCloud, CloudPieces);
//Set UserDictionary from DictionaryLists.
Dict_Utils.SetUserDict_FromOtherCloud(ref NewCloud, GlobalCloud);
//Set ColorGradient UserData
List <double> gradVals = new List <double>();
List <Color> gradCols = new List <Color>();
if (insV_Step > 0.00)
{
for (int i = 0; i < pos.Length; i++)
{
double gradVal = (Math.Floor((pos[i] - Itv[0]) / insV_Step) * insV_Step) + Itv[0];
if (!gradVals.Contains(gradVal))
{
Color gradCol = ColVal[(int)(Itv.NormalizedParameterAt(gradVal) * idx)];
gradVals.Add(gradVal);
gradCols.Add(gradCol);
}
}
double lastVal = (Math.Ceiling((pos[pos.Length - 1] - Itv[0]) / insV_Step) * insV_Step) + Itv[0];
if (!gradVals.Contains(lastVal))
{
Color gradCol = ColVal[(int)(Itv.NormalizedParameterAt(pos[pos.Length - 1]) * idx)];
gradVals.Add(lastVal);
gradCols.Add(gradCol);
}
}
else
{
gradVals = insV_Values;
gradCols = insV_Colors;
}
Color_Utils.Set_ColorGradient_Dict(ref NewCloud, gradCols, gradVals);
//Dispose of Global Clouds.
GlobalCloud.Dispose();
pointCloud.Dispose();
//Set OutputCloud
pointCloud = (PointCloud)NewCloud.Duplicate();
//Dispose of PointCloud Pieces and NewCloud.
CloudPieces = null;
NewCloud.Dispose();
#endregion - End of Finalize Execution
//Return True on Finish
return(true);
}
