public void PushQueryNode(int index, float3 closestPoint, float3 queryPosition) { float lengthsq = math.lengthsq(closestPoint - queryPosition); MinHeap.PushObjMin(new QueryNode { NodeIndex = index, TempClosestPoint = closestPoint, Distance = lengthsq }, lengthsq); }