public Vector3d Project(Vector3d vPoint, int identifier = -1)
{
int tNearestID = Spatial.FindNearestTriangle(vPoint);
DistPoint3Triangle3 q = MeshQueries.TriangleDistance(Mesh, tNearestID, vPoint);
return(q.TriangleClosest);
}
public Vector3d FindNearestAndOffset(Vector3d pos)
{
int tNearestID = Spatial.FindNearestTriangle(pos);
DistPoint3Triangle3 q = MeshQueries.TriangleDistance(Mesh, tNearestID, pos);
Vector3d vHitNormal =
(UseFaceNormal == false && Mesh.HasVertexNormals) ?
Mesh.GetTriBaryNormal(tNearestID, q.TriangleBaryCoords.x, q.TriangleBaryCoords.y, q.TriangleBaryCoords.z)
: Mesh.GetTriNormal(tNearestID);
return(q.TriangleClosest + Distance * vHitNormal);
}
// for each From[i], find closest point on TargetSurface
void update_to()
{
double max_dist = double.MaxValue;
bool bNormals = (UseNormals && Source.HasVertexNormals);
var range = Interval1i.Range(From.Length);
gParallel.ForEach(range, (vi) =>
{
int tid = TargetSurface.FindNearestTriangle(From[vi], max_dist);
if (tid == DMesh3.InvalidID)
{
Weights[vi] = 0;
return;
}
DistPoint3Triangle3 d = MeshQueries.TriangleDistance(TargetSurface.Mesh, tid, From[vi]);
if (d.DistanceSquared > MaxAllowableDistance * MaxAllowableDistance)
{
Weights[vi] = 0;
return;
}
To[vi] = d.TriangleClosest;
Weights[vi] = 1.0f;
if (bNormals)
{
Vector3d fromN = Rotation * Source.GetVertexNormal(vi);
Vector3d toN = TargetSurface.Mesh.GetTriNormal(tid);
double fDot = fromN.Dot(toN);
Debug.Assert(MathUtil.IsFinite(fDot));
if (fDot < 0)
{
Weights[vi] = 0;
}
else
{
Weights[vi] += Math.Sqrt(fDot);
}
}
});
}
