[1114] | 1 | using System;
|
---|
| 2 | using System.Collections.Generic;
|
---|
| 3 |
|
---|
| 4 | namespace Oni.Akira
|
---|
| 5 | {
|
---|
| 6 | internal class PolygonUtils
|
---|
| 7 | {
|
---|
| 8 | public static List<Vector3> ClipToPlane(List<Vector3> points, Plane plane)
|
---|
| 9 | {
|
---|
| 10 | var signs = new int[points.Count];
|
---|
| 11 | var negativeCount = 0;
|
---|
| 12 | var positiveCount = 0;
|
---|
| 13 | var start = 0;
|
---|
| 14 |
|
---|
| 15 | for (int i = 0; i < points.Count; i++)
|
---|
| 16 | {
|
---|
| 17 | signs[i] = RelativePosition(points[i], plane);
|
---|
| 18 |
|
---|
| 19 | if (signs[i] >= 0)
|
---|
| 20 | positiveCount++;
|
---|
| 21 |
|
---|
| 22 | if (signs[i] <= 0)
|
---|
| 23 | negativeCount++;
|
---|
| 24 | }
|
---|
| 25 |
|
---|
| 26 | if (negativeCount == points.Count)
|
---|
| 27 | return null;
|
---|
| 28 |
|
---|
| 29 | if (positiveCount == points.Count)
|
---|
| 30 | return points;
|
---|
| 31 |
|
---|
| 32 | var newPoints = new List<Vector3>();
|
---|
| 33 |
|
---|
| 34 | for (int i = 0; i < points.Count; i++)
|
---|
| 35 | {
|
---|
| 36 | int i0 = (i + start) % points.Count;
|
---|
| 37 | int i1 = (i + start + 1) % points.Count;
|
---|
| 38 |
|
---|
| 39 | int s0 = signs[i0];
|
---|
| 40 | int s1 = signs[i1];
|
---|
| 41 |
|
---|
| 42 | if (s0 >= 0)
|
---|
| 43 | {
|
---|
| 44 | newPoints.Add(points[i0]);
|
---|
| 45 |
|
---|
| 46 | if (s0 > 0 && s1 < 0)
|
---|
| 47 | newPoints.Add(Intersect(points[i0], points[i1], plane));
|
---|
| 48 | }
|
---|
| 49 | else
|
---|
| 50 | {
|
---|
| 51 | if (s0 < 0 && s1 > 0)
|
---|
| 52 | newPoints.Add(Intersect(points[i1], points[i0], plane));
|
---|
| 53 | }
|
---|
| 54 | }
|
---|
| 55 |
|
---|
| 56 | return newPoints;
|
---|
| 57 | }
|
---|
| 58 |
|
---|
| 59 | private static Vector3 Intersect(Vector3 p0, Vector3 p1, Plane plane)
|
---|
| 60 | {
|
---|
| 61 | Vector3 dir = p1 - p0;
|
---|
| 62 |
|
---|
| 63 | float dND = plane.DotNormal(dir);
|
---|
| 64 |
|
---|
| 65 | if (Math.Abs(dND) < 1e-05f)
|
---|
| 66 | throw new InvalidOperationException();
|
---|
| 67 |
|
---|
| 68 | float distance = (-plane.D - plane.DotNormal(p0)) / dND;
|
---|
| 69 |
|
---|
| 70 | if (distance < 0.0f)
|
---|
| 71 | {
|
---|
| 72 | if (distance < -1e-05f)
|
---|
| 73 | throw new InvalidOperationException();
|
---|
| 74 |
|
---|
| 75 | return p0;
|
---|
| 76 | }
|
---|
| 77 | else
|
---|
| 78 | {
|
---|
| 79 | return p0 + dir * distance;
|
---|
| 80 | }
|
---|
| 81 | }
|
---|
| 82 |
|
---|
| 83 | private static int RelativePosition(Vector3 point, Plane plane)
|
---|
| 84 | {
|
---|
| 85 | float pos = plane.DotCoordinate(point);
|
---|
| 86 |
|
---|
| 87 | if (pos < -1e-05f)
|
---|
| 88 | return -1;
|
---|
| 89 | else if (pos > 1e-05f)
|
---|
| 90 | return 1;
|
---|
| 91 | else
|
---|
| 92 | return 0;
|
---|
| 93 | }
|
---|
| 94 | }
|
---|
| 95 | }
|
---|