public void SetNode(Node n, float loose)
{
n.parent = this;
if (children == null)
{
children = new Node[4];
}
children[n.index] = n;
#if UNITY_EDITOR
var b = GetSubBounds(n.index, loose);
Debug.Assert(MUtils.Approximately(n.bounds.min, b.min));
Debug.Assert(MUtils.Approximately(n.bounds.max, b.max));
#endif
}
// this -> P + D*t
// other -> line.P + line.D*s
public bool Intersects(Line2D line, out float t, out float s)
{
// P0 + D0t = P1 + D1s => D0t - D1s = P1 - P0
// P1 - P0 -> K
// Kross D0 at both side -> -Kross(D0, D1)s = Kross(D0, K) => s = Kross(D0, K)/Kross(D1, D0)
// Kross D1 at both side -> -Kross(D0, D1)t = Kross(D1, K) => t = Kross(D1, K)/Kross(D1, D0)
// condition -> Kross(D1, D0) != 0
float kross = Kross(line.D, D);
if (!MUtils.Approximately(kross, 0f))
{
Vector2 K = line.P - P;
s = Kross(D, K) / kross;
t = Kross(line.D, K) / kross;
return(true);
}
s = t = 0;
return(false);
}
public Triangle[] ClipBy(Plane inPlane)
{
Vector3 ptOnPlane = -inPlane.normal * inPlane.distance;
float dot0 = Vector3.Dot(p0.vertex - ptOnPlane, inPlane.normal);
float dot1 = Vector3.Dot(p1.vertex - ptOnPlane, inPlane.normal);
float dot2 = Vector3.Dot(p2.vertex - ptOnPlane, inPlane.normal);
int dr0 = MUtils.Approximately(dot0, 0f) ? 0 : (dot0 < 0f ? -1 : 1);
int dr1 = MUtils.Approximately(dot1, 0f) ? 0 : (dot1 < 0f ? -1 : 1);
int dr2 = MUtils.Approximately(dot2, 0f) ? 0 : (dot2 < 0f ? -1 : 1);
if (dr0 > 0 && dr1 > 0 && dr2 > 0)
{
return(null);
}
if (dr0 < 0 && dr1 < 0 && dr2 < 0)
{
return new Triangle[] { this }
}
;
// one edge lay on the plane
System.Func <int, int, int, bool> check = delegate(int kr0, int kr1, int kr2)
{
if (kr0 == 0 && kr1 == 0)
{
return(kr2 <= 0);
}
return(false);
};
if (check(dr0, dr1, dr2) || check(dr0, dr2, dr1) ||
check(dr1, dr0, dr2) || check(dr1, dr2, dr0) ||
check(dr2, dr0, dr1) || check(dr2, dr1, dr0))
{
return(new Triangle[] { this });
}
List <Triangle> tris = new List <Triangle>();
Func <int, int, int, Vertex, Vertex, Vertex, bool> clip = delegate(int kr0, int kr1, int kr2, Vertex pt0, Vertex pt1, Vertex pt2)
{
if (kr0 > 0) // p0 at positive side
{
float enter;
if (kr1 < 0 && kr2 < 0) // other two on nagetive plane
{
var r = new Ray(pt0.vertex, pt1.vertex - pt0.vertex);
inPlane.Raycast(r, out enter);
var t0 = r.GetPoint(enter);
Vertex tt0 = new Vertex();
tt0.vertex = t0;
tt0.uv = pt0.uv + (pt1.uv - pt0.uv) * enter;
tt0.uv2 = pt0.uv2 + (pt1.uv2 - pt0.uv2) * enter;
tt0.uv3 = pt0.uv3 + (pt1.uv3 - pt0.uv3) * enter;
tt0.uv4 = pt0.uv4 + (pt1.uv4 - pt0.uv4) * enter;
r = new Ray(pt0.vertex, pt2.vertex - pt0.vertex);
inPlane.Raycast(r, out enter);
var t1 = r.GetPoint(enter);
Vertex tt1 = new Vertex();
tt1.vertex = t1;
tt1.uv = pt0.uv + (pt2.uv - pt0.uv) * enter;
tt1.uv2 = pt0.uv2 + (pt2.uv2 - pt0.uv2) * enter;
tt1.uv3 = pt0.uv3 + (pt2.uv3 - pt0.uv3) * enter;
tt1.uv4 = pt0.uv4 + (pt2.uv4 - pt0.uv4) * enter;
tris.Add(new Triangle(tt0, pt1, pt2));
tris.Add(new Triangle(tt0, pt2, tt1));
}
else if (kr1 > 0 && kr2 < 0) // p1 at positive side. p2 at nagetive side
{
var r = new Ray(pt0.vertex, pt2.vertex - pt0.vertex);
inPlane.Raycast(r, out enter);
var t0 = r.GetPoint(enter);
Vertex tt0 = new Vertex();
tt0.vertex = t0;
tt0.uv = pt0.uv + (pt2.uv - pt0.uv) * enter;
tt0.uv2 = pt0.uv2 + (pt2.uv2 - pt0.uv2) * enter;
tt0.uv3 = pt0.uv3 + (pt2.uv3 - pt0.uv3) * enter;
tt0.uv4 = pt0.uv4 + (pt2.uv4 - pt0.uv4) * enter;
r = new Ray(pt1.vertex, pt2.vertex - pt1.vertex);
inPlane.Raycast(r, out enter);
var t1 = r.GetPoint(enter);
Vertex tt1 = new Vertex();
tt1.vertex = t1;
tt1.uv = pt1.uv + (pt2.uv - pt1.uv) * enter;
tt1.uv2 = pt1.uv2 + (pt2.uv2 - pt1.uv2) * enter;
tt1.uv3 = pt1.uv3 + (pt2.uv3 - pt1.uv3) * enter;
tt1.uv4 = pt1.uv4 + (pt2.uv4 - pt1.uv4) * enter;
tris.Add(new Triangle(tt0, pt2, tt1));
}
else if (kr1 < 0 && kr2 > 0) // p2 at positive side, p1 at nagetive side,
{
var r = new Ray(pt0.vertex, pt1.vertex - pt0.vertex);
inPlane.Raycast(r, out enter);
var t0 = r.GetPoint(enter);
Vertex tt0 = new Vertex();
tt0.vertex = t0;
tt0.uv = pt0.uv + (pt1.uv - pt0.uv) * enter;
tt0.uv2 = pt0.uv2 + (pt1.uv2 - pt0.uv2) * enter;
tt0.uv3 = pt0.uv3 + (pt1.uv3 - pt0.uv3) * enter;
tt0.uv4 = pt0.uv4 + (pt1.uv4 - pt0.uv4) * enter;
r = new Ray(pt2.vertex, pt1.vertex - pt2.vertex);
inPlane.Raycast(r, out enter);
var t1 = r.GetPoint(enter);
Vertex tt1 = new Vertex();
tt1.vertex = t1;
tt1.uv = pt2.uv + (pt2.uv - pt1.uv) * enter;
tt1.uv2 = pt2.uv2 + (pt2.uv2 - pt1.uv2) * enter;
tt1.uv3 = pt2.uv3 + (pt2.uv3 - pt1.uv3) * enter;
tt1.uv4 = pt2.uv4 + (pt2.uv4 - pt1.uv4) * enter;
tris.Add(new Triangle(tt0, pt1, tt1));
}
return(true);
}
return(false);
};
bool clipped = clip(dr0, dr1, dr2, p0, p1, p2);
clipped = clipped || clip(dr1, dr2, dr0, p1, p2, p0);
clipped = clipped || clip(dr2, dr0, dr1, p2, p0, p1);
return(tris.ToArray());
}
}
