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);
}