| Index: experimental/Intersection/QuadraticImplicit.cpp
|
| diff --git a/experimental/Intersection/QuadraticImplicit.cpp b/experimental/Intersection/QuadraticImplicit.cpp
|
| deleted file mode 100644
|
| index f16ddd93703025a24c199e2e20ae1c7474b04020..0000000000000000000000000000000000000000
|
| --- a/experimental/Intersection/QuadraticImplicit.cpp
|
| +++ /dev/null
|
| @@ -1,572 +0,0 @@
|
| -// Another approach is to start with the implicit form of one curve and solve
|
| -// (seek implicit coefficients in QuadraticParameter.cpp
|
| -// by substituting in the parametric form of the other.
|
| -// The downside of this approach is that early rejects are difficult to come by.
|
| -// http://planetmath.org/encyclopedia/GaloisTheoreticDerivationOfTheQuarticFormula.html#step
|
| -
|
| -
|
| -#include "CubicUtilities.h"
|
| -#include "CurveIntersection.h"
|
| -#include "Intersections.h"
|
| -#include "QuadraticParameterization.h"
|
| -#include "QuarticRoot.h"
|
| -#include "QuadraticUtilities.h"
|
| -#include "TSearch.h"
|
| -
|
| -#ifdef SK_DEBUG
|
| -#include "LineUtilities.h"
|
| -#endif
|
| -
|
| -/* given the implicit form 0 = Ax^2 + Bxy + Cy^2 + Dx + Ey + F
|
| - * and given x = at^2 + bt + c (the parameterized form)
|
| - * y = dt^2 + et + f
|
| - * then
|
| - * 0 = A(at^2+bt+c)(at^2+bt+c)+B(at^2+bt+c)(dt^2+et+f)+C(dt^2+et+f)(dt^2+et+f)+D(at^2+bt+c)+E(dt^2+et+f)+F
|
| - */
|
| -
|
| -static int findRoots(const QuadImplicitForm& i, const Quadratic& q2, double roots[4],
|
| - bool oneHint, int firstCubicRoot) {
|
| - double a, b, c;
|
| - set_abc(&q2[0].x, a, b, c);
|
| - double d, e, f;
|
| - set_abc(&q2[0].y, d, e, f);
|
| - const double t4 = i.x2() * a * a
|
| - + i.xy() * a * d
|
| - + i.y2() * d * d;
|
| - const double t3 = 2 * i.x2() * a * b
|
| - + i.xy() * (a * e + b * d)
|
| - + 2 * i.y2() * d * e;
|
| - const double t2 = i.x2() * (b * b + 2 * a * c)
|
| - + i.xy() * (c * d + b * e + a * f)
|
| - + i.y2() * (e * e + 2 * d * f)
|
| - + i.x() * a
|
| - + i.y() * d;
|
| - const double t1 = 2 * i.x2() * b * c
|
| - + i.xy() * (c * e + b * f)
|
| - + 2 * i.y2() * e * f
|
| - + i.x() * b
|
| - + i.y() * e;
|
| - const double t0 = i.x2() * c * c
|
| - + i.xy() * c * f
|
| - + i.y2() * f * f
|
| - + i.x() * c
|
| - + i.y() * f
|
| - + i.c();
|
| - int rootCount = reducedQuarticRoots(t4, t3, t2, t1, t0, oneHint, roots);
|
| - if (rootCount >= 0) {
|
| - return rootCount;
|
| - }
|
| - return quarticRootsReal(firstCubicRoot, t4, t3, t2, t1, t0, roots);
|
| -}
|
| -
|
| -static int addValidRoots(const double roots[4], const int count, double valid[4]) {
|
| - int result = 0;
|
| - int index;
|
| - for (index = 0; index < count; ++index) {
|
| - if (!approximately_zero_or_more(roots[index]) || !approximately_one_or_less(roots[index])) {
|
| - continue;
|
| - }
|
| - double t = 1 - roots[index];
|
| - if (approximately_less_than_zero(t)) {
|
| - t = 0;
|
| - } else if (approximately_greater_than_one(t)) {
|
| - t = 1;
|
| - }
|
| - valid[result++] = t;
|
| - }
|
| - return result;
|
| -}
|
| -
|
| -static bool onlyEndPtsInCommon(const Quadratic& q1, const Quadratic& q2, Intersections& i) {
|
| -// the idea here is to see at minimum do a quick reject by rotating all points
|
| -// to either side of the line formed by connecting the endpoints
|
| -// if the opposite curves points are on the line or on the other side, the
|
| -// curves at most intersect at the endpoints
|
| - for (int oddMan = 0; oddMan < 3; ++oddMan) {
|
| - const _Point* endPt[2];
|
| - for (int opp = 1; opp < 3; ++opp) {
|
| - int end = oddMan ^ opp;
|
| - if (end == 3) {
|
| - end = opp;
|
| - }
|
| - endPt[opp - 1] = &q1[end];
|
| - }
|
| - double origX = endPt[0]->x;
|
| - double origY = endPt[0]->y;
|
| - double adj = endPt[1]->x - origX;
|
| - double opp = endPt[1]->y - origY;
|
| - double sign = (q1[oddMan].y - origY) * adj - (q1[oddMan].x - origX) * opp;
|
| - if (approximately_zero(sign)) {
|
| - goto tryNextHalfPlane;
|
| - }
|
| - for (int n = 0; n < 3; ++n) {
|
| - double test = (q2[n].y - origY) * adj - (q2[n].x - origX) * opp;
|
| - if (test * sign > 0) {
|
| - goto tryNextHalfPlane;
|
| - }
|
| - }
|
| - for (int i1 = 0; i1 < 3; i1 += 2) {
|
| - for (int i2 = 0; i2 < 3; i2 += 2) {
|
| - if (q1[i1] == q2[i2]) {
|
| - i.insert(i1 >> 1, i2 >> 1, q1[i1]);
|
| - }
|
| - }
|
| - }
|
| - SkASSERT(i.fUsed < 3);
|
| - return true;
|
| -tryNextHalfPlane:
|
| - ;
|
| - }
|
| - return false;
|
| -}
|
| -
|
| -// returns false if there's more than one intercept or the intercept doesn't match the point
|
| -// returns true if the intercept was successfully added or if the
|
| -// original quads need to be subdivided
|
| -static bool addIntercept(const Quadratic& q1, const Quadratic& q2, double tMin, double tMax,
|
| - Intersections& i, bool* subDivide) {
|
| - double tMid = (tMin + tMax) / 2;
|
| - _Point mid;
|
| - xy_at_t(q2, tMid, mid.x, mid.y);
|
| - _Line line;
|
| - line[0] = line[1] = mid;
|
| - _Vector dxdy = dxdy_at_t(q2, tMid);
|
| - line[0] -= dxdy;
|
| - line[1] += dxdy;
|
| - Intersections rootTs;
|
| - int roots = intersect(q1, line, rootTs);
|
| - if (roots == 0) {
|
| - if (subDivide) {
|
| - *subDivide = true;
|
| - }
|
| - return true;
|
| - }
|
| - if (roots == 2) {
|
| - return false;
|
| - }
|
| - _Point pt2;
|
| - xy_at_t(q1, rootTs.fT[0][0], pt2.x, pt2.y);
|
| - if (!pt2.approximatelyEqualHalf(mid)) {
|
| - return false;
|
| - }
|
| - i.insertSwap(rootTs.fT[0][0], tMid, pt2);
|
| - return true;
|
| -}
|
| -
|
| -static bool isLinearInner(const Quadratic& q1, double t1s, double t1e, const Quadratic& q2,
|
| - double t2s, double t2e, Intersections& i, bool* subDivide) {
|
| - Quadratic hull;
|
| - sub_divide(q1, t1s, t1e, hull);
|
| - _Line line = {hull[2], hull[0]};
|
| - const _Line* testLines[] = { &line, (const _Line*) &hull[0], (const _Line*) &hull[1] };
|
| - size_t testCount = sizeof(testLines) / sizeof(testLines[0]);
|
| - SkTDArray<double> tsFound;
|
| - for (size_t index = 0; index < testCount; ++index) {
|
| - Intersections rootTs;
|
| - int roots = intersect(q2, *testLines[index], rootTs);
|
| - for (int idx2 = 0; idx2 < roots; ++idx2) {
|
| - double t = rootTs.fT[0][idx2];
|
| -#ifdef SK_DEBUG
|
| - _Point qPt, lPt;
|
| - xy_at_t(q2, t, qPt.x, qPt.y);
|
| - xy_at_t(*testLines[index], rootTs.fT[1][idx2], lPt.x, lPt.y);
|
| - SkASSERT(qPt.approximatelyEqual(lPt));
|
| -#endif
|
| - if (approximately_negative(t - t2s) || approximately_positive(t - t2e)) {
|
| - continue;
|
| - }
|
| - *tsFound.append() = rootTs.fT[0][idx2];
|
| - }
|
| - }
|
| - int tCount = tsFound.count();
|
| - if (!tCount) {
|
| - return true;
|
| - }
|
| - double tMin, tMax;
|
| - if (tCount == 1) {
|
| - tMin = tMax = tsFound[0];
|
| - } else if (tCount > 1) {
|
| - QSort<double>(tsFound.begin(), tsFound.end() - 1);
|
| - tMin = tsFound[0];
|
| - tMax = tsFound[tsFound.count() - 1];
|
| - }
|
| - _Point end;
|
| - xy_at_t(q2, t2s, end.x, end.y);
|
| - bool startInTriangle = point_in_hull(hull, end);
|
| - if (startInTriangle) {
|
| - tMin = t2s;
|
| - }
|
| - xy_at_t(q2, t2e, end.x, end.y);
|
| - bool endInTriangle = point_in_hull(hull, end);
|
| - if (endInTriangle) {
|
| - tMax = t2e;
|
| - }
|
| - int split = 0;
|
| - _Vector dxy1, dxy2;
|
| - if (tMin != tMax || tCount > 2) {
|
| - dxy2 = dxdy_at_t(q2, tMin);
|
| - for (int index = 1; index < tCount; ++index) {
|
| - dxy1 = dxy2;
|
| - dxy2 = dxdy_at_t(q2, tsFound[index]);
|
| - double dot = dxy1.dot(dxy2);
|
| - if (dot < 0) {
|
| - split = index - 1;
|
| - break;
|
| - }
|
| - }
|
| -
|
| - }
|
| - if (split == 0) { // there's one point
|
| - if (addIntercept(q1, q2, tMin, tMax, i, subDivide)) {
|
| - return true;
|
| - }
|
| - i.swap();
|
| - return isLinearInner(q2, tMin, tMax, q1, t1s, t1e, i, subDivide);
|
| - }
|
| - // At this point, we have two ranges of t values -- treat each separately at the split
|
| - bool result;
|
| - if (addIntercept(q1, q2, tMin, tsFound[split - 1], i, subDivide)) {
|
| - result = true;
|
| - } else {
|
| - i.swap();
|
| - result = isLinearInner(q2, tMin, tsFound[split - 1], q1, t1s, t1e, i, subDivide);
|
| - }
|
| - if (addIntercept(q1, q2, tsFound[split], tMax, i, subDivide)) {
|
| - result = true;
|
| - } else {
|
| - i.swap();
|
| - result |= isLinearInner(q2, tsFound[split], tMax, q1, t1s, t1e, i, subDivide);
|
| - }
|
| - return result;
|
| -}
|
| -
|
| -static double flatMeasure(const Quadratic& q) {
|
| - _Vector mid = q[1] - q[0];
|
| - _Vector dxy = q[2] - q[0];
|
| - double length = dxy.length(); // OPTIMIZE: get rid of sqrt
|
| - return fabs(mid.cross(dxy) / length);
|
| -}
|
| -
|
| -// FIXME ? should this measure both and then use the quad that is the flattest as the line?
|
| -static bool isLinear(const Quadratic& q1, const Quadratic& q2, Intersections& i) {
|
| - double measure = flatMeasure(q1);
|
| - // OPTIMIZE: (get rid of sqrt) use approximately_zero
|
| - if (!approximately_zero_sqrt(measure)) {
|
| - return false;
|
| - }
|
| - return isLinearInner(q1, 0, 1, q2, 0, 1, i, NULL);
|
| -}
|
| -
|
| -// FIXME: if flat measure is sufficiently large, then probably the quartic solution failed
|
| -static void relaxedIsLinear(const Quadratic& q1, const Quadratic& q2, Intersections& i) {
|
| - double m1 = flatMeasure(q1);
|
| - double m2 = flatMeasure(q2);
|
| -#ifdef SK_DEBUG
|
| - double min = SkTMin(m1, m2);
|
| - if (min > 5) {
|
| - SkDebugf("%s maybe not flat enough.. %1.9g\n", __FUNCTION__, min);
|
| - }
|
| -#endif
|
| - i.reset();
|
| - const Quadratic& rounder = m2 < m1 ? q1 : q2;
|
| - const Quadratic& flatter = m2 < m1 ? q2 : q1;
|
| - bool subDivide = false;
|
| - isLinearInner(flatter, 0, 1, rounder, 0, 1, i, &subDivide);
|
| - if (subDivide) {
|
| - QuadraticPair pair;
|
| - chop_at(flatter, pair, 0.5);
|
| - Intersections firstI, secondI;
|
| - relaxedIsLinear(pair.first(), rounder, firstI);
|
| - for (int index = 0; index < firstI.used(); ++index) {
|
| - i.insert(firstI.fT[0][index] * 0.5, firstI.fT[1][index], firstI.fPt[index]);
|
| - }
|
| - relaxedIsLinear(pair.second(), rounder, secondI);
|
| - for (int index = 0; index < secondI.used(); ++index) {
|
| - i.insert(0.5 + secondI.fT[0][index] * 0.5, secondI.fT[1][index], secondI.fPt[index]);
|
| - }
|
| - }
|
| - if (m2 < m1) {
|
| - i.swapPts();
|
| - }
|
| -}
|
| -
|
| -#if 0
|
| -static void unsortableExpanse(const Quadratic& q1, const Quadratic& q2, Intersections& i) {
|
| - const Quadratic* qs[2] = { &q1, &q2 };
|
| - // need t values for start and end of unsortable expanse on both curves
|
| - // try projecting lines parallel to the end points
|
| - i.fT[0][0] = 0;
|
| - i.fT[0][1] = 1;
|
| - int flip = -1; // undecided
|
| - for (int qIdx = 0; qIdx < 2; qIdx++) {
|
| - for (int t = 0; t < 2; t++) {
|
| - _Point dxdy;
|
| - dxdy_at_t(*qs[qIdx], t, dxdy);
|
| - _Line perp;
|
| - perp[0] = perp[1] = (*qs[qIdx])[t == 0 ? 0 : 2];
|
| - perp[0].x += dxdy.y;
|
| - perp[0].y -= dxdy.x;
|
| - perp[1].x -= dxdy.y;
|
| - perp[1].y += dxdy.x;
|
| - Intersections hitData;
|
| - int hits = intersectRay(*qs[qIdx ^ 1], perp, hitData);
|
| - SkASSERT(hits <= 1);
|
| - if (hits) {
|
| - if (flip < 0) {
|
| - _Point dxdy2;
|
| - dxdy_at_t(*qs[qIdx ^ 1], hitData.fT[0][0], dxdy2);
|
| - double dot = dxdy.dot(dxdy2);
|
| - flip = dot < 0;
|
| - i.fT[1][0] = flip;
|
| - i.fT[1][1] = !flip;
|
| - }
|
| - i.fT[qIdx ^ 1][t ^ flip] = hitData.fT[0][0];
|
| - }
|
| - }
|
| - }
|
| - i.fUnsortable = true; // failed, probably coincident or near-coincident
|
| - i.fUsed = 2;
|
| -}
|
| -#endif
|
| -
|
| -// each time through the loop, this computes values it had from the last loop
|
| -// if i == j == 1, the center values are still good
|
| -// otherwise, for i != 1 or j != 1, four of the values are still good
|
| -// and if i == 1 ^ j == 1, an additional value is good
|
| -static bool binarySearch(const Quadratic& quad1, const Quadratic& quad2, double& t1Seed,
|
| - double& t2Seed, _Point& pt) {
|
| - double tStep = ROUGH_EPSILON;
|
| - _Point t1[3], t2[3];
|
| - int calcMask = ~0;
|
| - do {
|
| - if (calcMask & (1 << 1)) t1[1] = xy_at_t(quad1, t1Seed);
|
| - if (calcMask & (1 << 4)) t2[1] = xy_at_t(quad2, t2Seed);
|
| - if (t1[1].approximatelyEqual(t2[1])) {
|
| - pt = t1[1];
|
| - #if ONE_OFF_DEBUG
|
| - SkDebugf("%s t1=%1.9g t2=%1.9g (%1.9g,%1.9g) == (%1.9g,%1.9g)\n", __FUNCTION__,
|
| - t1Seed, t2Seed, t1[1].x, t1[1].y, t1[2].x, t1[2].y);
|
| - #endif
|
| - return true;
|
| - }
|
| - if (calcMask & (1 << 0)) t1[0] = xy_at_t(quad1, t1Seed - tStep);
|
| - if (calcMask & (1 << 2)) t1[2] = xy_at_t(quad1, t1Seed + tStep);
|
| - if (calcMask & (1 << 3)) t2[0] = xy_at_t(quad2, t2Seed - tStep);
|
| - if (calcMask & (1 << 5)) t2[2] = xy_at_t(quad2, t2Seed + tStep);
|
| - double dist[3][3];
|
| - // OPTIMIZE: using calcMask value permits skipping some distance calcuations
|
| - // if prior loop's results are moved to correct slot for reuse
|
| - dist[1][1] = t1[1].distanceSquared(t2[1]);
|
| - int best_i = 1, best_j = 1;
|
| - for (int i = 0; i < 3; ++i) {
|
| - for (int j = 0; j < 3; ++j) {
|
| - if (i == 1 && j == 1) {
|
| - continue;
|
| - }
|
| - dist[i][j] = t1[i].distanceSquared(t2[j]);
|
| - if (dist[best_i][best_j] > dist[i][j]) {
|
| - best_i = i;
|
| - best_j = j;
|
| - }
|
| - }
|
| - }
|
| - if (best_i == 1 && best_j == 1) {
|
| - tStep /= 2;
|
| - if (tStep < FLT_EPSILON_HALF) {
|
| - break;
|
| - }
|
| - calcMask = (1 << 0) | (1 << 2) | (1 << 3) | (1 << 5);
|
| - continue;
|
| - }
|
| - if (best_i == 0) {
|
| - t1Seed -= tStep;
|
| - t1[2] = t1[1];
|
| - t1[1] = t1[0];
|
| - calcMask = 1 << 0;
|
| - } else if (best_i == 2) {
|
| - t1Seed += tStep;
|
| - t1[0] = t1[1];
|
| - t1[1] = t1[2];
|
| - calcMask = 1 << 2;
|
| - } else {
|
| - calcMask = 0;
|
| - }
|
| - if (best_j == 0) {
|
| - t2Seed -= tStep;
|
| - t2[2] = t2[1];
|
| - t2[1] = t2[0];
|
| - calcMask |= 1 << 3;
|
| - } else if (best_j == 2) {
|
| - t2Seed += tStep;
|
| - t2[0] = t2[1];
|
| - t2[1] = t2[2];
|
| - calcMask |= 1 << 5;
|
| - }
|
| - } while (true);
|
| -#if ONE_OFF_DEBUG
|
| - SkDebugf("%s t1=%1.9g t2=%1.9g (%1.9g,%1.9g) != (%1.9g,%1.9g) %s\n", __FUNCTION__,
|
| - t1Seed, t2Seed, t1[1].x, t1[1].y, t1[2].x, t1[2].y);
|
| -#endif
|
| - return false;
|
| -}
|
| -
|
| -bool intersect2(const Quadratic& q1, const Quadratic& q2, Intersections& i) {
|
| - // if the quads share an end point, check to see if they overlap
|
| -
|
| - if (onlyEndPtsInCommon(q1, q2, i)) {
|
| - return i.intersected();
|
| - }
|
| - if (onlyEndPtsInCommon(q2, q1, i)) {
|
| - i.swapPts();
|
| - return i.intersected();
|
| - }
|
| - // see if either quad is really a line
|
| - if (isLinear(q1, q2, i)) {
|
| - return i.intersected();
|
| - }
|
| - if (isLinear(q2, q1, i)) {
|
| - i.swapPts();
|
| - return i.intersected();
|
| - }
|
| - QuadImplicitForm i1(q1);
|
| - QuadImplicitForm i2(q2);
|
| - if (i1.implicit_match(i2)) {
|
| - // FIXME: compute T values
|
| - // compute the intersections of the ends to find the coincident span
|
| - bool useVertical = fabs(q1[0].x - q1[2].x) < fabs(q1[0].y - q1[2].y);
|
| - double t;
|
| - if ((t = axialIntersect(q1, q2[0], useVertical)) >= 0) {
|
| - i.insertCoincident(t, 0, q2[0]);
|
| - }
|
| - if ((t = axialIntersect(q1, q2[2], useVertical)) >= 0) {
|
| - i.insertCoincident(t, 1, q2[2]);
|
| - }
|
| - useVertical = fabs(q2[0].x - q2[2].x) < fabs(q2[0].y - q2[2].y);
|
| - if ((t = axialIntersect(q2, q1[0], useVertical)) >= 0) {
|
| - i.insertCoincident(0, t, q1[0]);
|
| - }
|
| - if ((t = axialIntersect(q2, q1[2], useVertical)) >= 0) {
|
| - i.insertCoincident(1, t, q1[2]);
|
| - }
|
| - SkASSERT(i.coincidentUsed() <= 2);
|
| - return i.coincidentUsed() > 0;
|
| - }
|
| - int index;
|
| - bool useCubic = q1[0] == q2[0] || q1[0] == q2[2] || q1[2] == q2[0];
|
| - double roots1[4];
|
| - int rootCount = findRoots(i2, q1, roots1, useCubic, 0);
|
| - // OPTIMIZATION: could short circuit here if all roots are < 0 or > 1
|
| - double roots1Copy[4];
|
| - int r1Count = addValidRoots(roots1, rootCount, roots1Copy);
|
| - _Point pts1[4];
|
| - for (index = 0; index < r1Count; ++index) {
|
| - xy_at_t(q1, roots1Copy[index], pts1[index].x, pts1[index].y);
|
| - }
|
| - double roots2[4];
|
| - int rootCount2 = findRoots(i1, q2, roots2, useCubic, 0);
|
| - double roots2Copy[4];
|
| - int r2Count = addValidRoots(roots2, rootCount2, roots2Copy);
|
| - _Point pts2[4];
|
| - for (index = 0; index < r2Count; ++index) {
|
| - xy_at_t(q2, roots2Copy[index], pts2[index].x, pts2[index].y);
|
| - }
|
| - if (r1Count == r2Count && r1Count <= 1) {
|
| - if (r1Count == 1) {
|
| - if (pts1[0].approximatelyEqualHalf(pts2[0])) {
|
| - i.insert(roots1Copy[0], roots2Copy[0], pts1[0]);
|
| - } else if (pts1[0].moreRoughlyEqual(pts2[0])) {
|
| - // experiment: see if a different cubic solution provides the correct quartic answer
|
| - #if 0
|
| - for (int cu1 = 0; cu1 < 3; ++cu1) {
|
| - rootCount = findRoots(i2, q1, roots1, useCubic, cu1);
|
| - r1Count = addValidRoots(roots1, rootCount, roots1Copy);
|
| - if (r1Count == 0) {
|
| - continue;
|
| - }
|
| - for (int cu2 = 0; cu2 < 3; ++cu2) {
|
| - if (cu1 == 0 && cu2 == 0) {
|
| - continue;
|
| - }
|
| - rootCount2 = findRoots(i1, q2, roots2, useCubic, cu2);
|
| - r2Count = addValidRoots(roots2, rootCount2, roots2Copy);
|
| - if (r2Count == 0) {
|
| - continue;
|
| - }
|
| - SkASSERT(r1Count == 1 && r2Count == 1);
|
| - SkDebugf("*** [%d,%d] (%1.9g,%1.9g) %s (%1.9g,%1.9g)\n", cu1, cu2,
|
| - pts1[0].x, pts1[0].y, pts1[0].approximatelyEqualHalf(pts2[0])
|
| - ? "==" : "!=", pts2[0].x, pts2[0].y);
|
| - }
|
| - }
|
| - #endif
|
| - // experiment: try to find intersection by chasing t
|
| - rootCount = findRoots(i2, q1, roots1, useCubic, 0);
|
| - r1Count = addValidRoots(roots1, rootCount, roots1Copy);
|
| - rootCount2 = findRoots(i1, q2, roots2, useCubic, 0);
|
| - r2Count = addValidRoots(roots2, rootCount2, roots2Copy);
|
| - if (binarySearch(q1, q2, roots1Copy[0], roots2Copy[0], pts1[0])) {
|
| - i.insert(roots1Copy[0], roots2Copy[0], pts1[0]);
|
| - }
|
| - }
|
| - }
|
| - return i.intersected();
|
| - }
|
| - int closest[4];
|
| - double dist[4];
|
| - bool foundSomething = false;
|
| - for (index = 0; index < r1Count; ++index) {
|
| - dist[index] = DBL_MAX;
|
| - closest[index] = -1;
|
| - for (int ndex2 = 0; ndex2 < r2Count; ++ndex2) {
|
| - if (!pts2[ndex2].approximatelyEqualHalf(pts1[index])) {
|
| - continue;
|
| - }
|
| - double dx = pts2[ndex2].x - pts1[index].x;
|
| - double dy = pts2[ndex2].y - pts1[index].y;
|
| - double distance = dx * dx + dy * dy;
|
| - if (dist[index] <= distance) {
|
| - continue;
|
| - }
|
| - for (int outer = 0; outer < index; ++outer) {
|
| - if (closest[outer] != ndex2) {
|
| - continue;
|
| - }
|
| - if (dist[outer] < distance) {
|
| - goto next;
|
| - }
|
| - closest[outer] = -1;
|
| - }
|
| - dist[index] = distance;
|
| - closest[index] = ndex2;
|
| - foundSomething = true;
|
| - next:
|
| - ;
|
| - }
|
| - }
|
| - if (r1Count && r2Count && !foundSomething) {
|
| - relaxedIsLinear(q1, q2, i);
|
| - return i.intersected();
|
| - }
|
| - int used = 0;
|
| - do {
|
| - double lowest = DBL_MAX;
|
| - int lowestIndex = -1;
|
| - for (index = 0; index < r1Count; ++index) {
|
| - if (closest[index] < 0) {
|
| - continue;
|
| - }
|
| - if (roots1Copy[index] < lowest) {
|
| - lowestIndex = index;
|
| - lowest = roots1Copy[index];
|
| - }
|
| - }
|
| - if (lowestIndex < 0) {
|
| - break;
|
| - }
|
| - i.insert(roots1Copy[lowestIndex], roots2Copy[closest[lowestIndex]],
|
| - pts1[lowestIndex]);
|
| - closest[lowestIndex] = -1;
|
| - } while (++used < r1Count);
|
| - i.fFlip = false;
|
| - return i.intersected();
|
| -}
|
|
|