2012-02-03 22:07:47 +00:00
|
|
|
#include "CurveIntersection.h"
|
2012-01-10 21:46:10 +00:00
|
|
|
#include "Intersections.h"
|
2012-02-03 22:07:47 +00:00
|
|
|
#include "IntersectionUtilities.h"
|
2012-01-10 21:46:10 +00:00
|
|
|
#include "LineIntersection.h"
|
|
|
|
|
2012-02-03 22:07:47 +00:00
|
|
|
class CubicIntersections : public Intersections {
|
|
|
|
public:
|
|
|
|
|
|
|
|
CubicIntersections(const Cubic& c1, const Cubic& c2, Intersections& i)
|
|
|
|
: cubic1(c1)
|
|
|
|
, cubic2(c2)
|
|
|
|
, intersections(i)
|
|
|
|
, depth(0)
|
|
|
|
, splits(0) {
|
|
|
|
}
|
|
|
|
|
|
|
|
bool intersect() {
|
|
|
|
double minT1, minT2, maxT1, maxT2;
|
|
|
|
if (!bezier_clip(cubic2, cubic1, minT1, maxT1)) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
if (!bezier_clip(cubic1, cubic2, minT2, maxT2)) {
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
int split;
|
|
|
|
if (maxT1 - minT1 < maxT2 - minT2) {
|
|
|
|
intersections.swap();
|
|
|
|
minT2 = 0;
|
|
|
|
maxT2 = 1;
|
|
|
|
split = maxT1 - minT1 > tClipLimit;
|
|
|
|
} else {
|
|
|
|
minT1 = 0;
|
|
|
|
maxT1 = 1;
|
|
|
|
split = (maxT2 - minT2 > tClipLimit) << 1;
|
|
|
|
}
|
|
|
|
return chop(minT1, maxT1, minT2, maxT2, split);
|
|
|
|
}
|
|
|
|
|
|
|
|
protected:
|
2012-01-10 21:46:10 +00:00
|
|
|
|
2012-02-03 22:07:47 +00:00
|
|
|
bool intersect(double minT1, double maxT1, double minT2, double maxT2) {
|
|
|
|
Cubic smaller, larger;
|
|
|
|
// FIXME: carry last subdivide and reduceOrder result with cubic
|
|
|
|
sub_divide(cubic1, minT1, maxT1, intersections.swapped() ? larger : smaller);
|
|
|
|
sub_divide(cubic2, minT2, maxT2, intersections.swapped() ? smaller : larger);
|
2012-01-10 21:46:10 +00:00
|
|
|
Cubic smallResult;
|
2012-02-03 22:07:47 +00:00
|
|
|
if (reduceOrder(smaller, smallResult,
|
|
|
|
kReduceOrder_NoQuadraticsAllowed) <= 2) {
|
2012-01-10 21:46:10 +00:00
|
|
|
Cubic largeResult;
|
2012-02-03 22:07:47 +00:00
|
|
|
if (reduceOrder(larger, largeResult,
|
|
|
|
kReduceOrder_NoQuadraticsAllowed) <= 2) {
|
2012-01-10 21:46:10 +00:00
|
|
|
const _Line& smallLine = (const _Line&) smallResult;
|
|
|
|
const _Line& largeLine = (const _Line&) largeResult;
|
2012-02-03 22:07:47 +00:00
|
|
|
double smallT[2];
|
|
|
|
double largeT[2];
|
|
|
|
// FIXME: this doesn't detect or deal with coincident lines
|
|
|
|
if (!::intersect(smallLine, largeLine, smallT, largeT)) {
|
2012-01-10 21:46:10 +00:00
|
|
|
return false;
|
|
|
|
}
|
2012-02-03 22:07:47 +00:00
|
|
|
if (intersections.swapped()) {
|
|
|
|
smallT[0] = interp(minT2, maxT2, smallT[0]);
|
|
|
|
largeT[0] = interp(minT1, maxT1, largeT[0]);
|
|
|
|
} else {
|
|
|
|
smallT[0] = interp(minT1, maxT1, smallT[0]);
|
|
|
|
largeT[0] = interp(minT2, maxT2, largeT[0]);
|
|
|
|
}
|
|
|
|
intersections.add(smallT[0], largeT[0]);
|
2012-01-10 21:46:10 +00:00
|
|
|
return true;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
double minT, maxT;
|
|
|
|
if (!bezier_clip(smaller, larger, minT, maxT)) {
|
|
|
|
if (minT == maxT) {
|
2012-02-03 22:07:47 +00:00
|
|
|
if (intersections.swapped()) {
|
|
|
|
minT1 = (minT1 + maxT1) / 2;
|
|
|
|
minT2 = interp(minT2, maxT2, minT);
|
|
|
|
} else {
|
|
|
|
minT1 = interp(minT1, maxT1, minT);
|
|
|
|
minT2 = (minT2 + maxT2) / 2;
|
|
|
|
}
|
|
|
|
intersections.add(minT1, minT2);
|
2012-01-10 21:46:10 +00:00
|
|
|
return true;
|
|
|
|
}
|
|
|
|
return false;
|
|
|
|
}
|
2012-02-03 22:07:47 +00:00
|
|
|
|
|
|
|
int split;
|
|
|
|
if (intersections.swapped()) {
|
|
|
|
double newMinT1 = interp(minT1, maxT1, minT);
|
|
|
|
double newMaxT1 = interp(minT1, maxT1, maxT);
|
|
|
|
split = (newMaxT1 - newMinT1 > (maxT1 - minT1) * tClipLimit) << 1;
|
|
|
|
#define VERBOSE 0
|
|
|
|
#if VERBOSE
|
|
|
|
printf("%s d=%d s=%d new1=(%g,%g) old1=(%g,%g) split=%d\n",
|
|
|
|
__FUNCTION__, depth, splits, newMinT1, newMaxT1, minT1, maxT1,
|
|
|
|
split);
|
|
|
|
#endif
|
|
|
|
minT1 = newMinT1;
|
|
|
|
maxT1 = newMaxT1;
|
|
|
|
} else {
|
|
|
|
double newMinT2 = interp(minT2, maxT2, minT);
|
|
|
|
double newMaxT2 = interp(minT2, maxT2, maxT);
|
|
|
|
split = newMaxT2 - newMinT2 > (maxT2 - minT2) * tClipLimit;
|
|
|
|
#if VERBOSE
|
|
|
|
printf("%s d=%d s=%d new2=(%g,%g) old2=(%g,%g) split=%d\n",
|
|
|
|
__FUNCTION__, depth, splits, newMinT2, newMaxT2, minT2, maxT2,
|
|
|
|
split);
|
|
|
|
#endif
|
|
|
|
minT2 = newMinT2;
|
|
|
|
maxT2 = newMaxT2;
|
|
|
|
}
|
|
|
|
return chop(minT1, maxT1, minT2, maxT2, split);
|
2012-01-10 21:46:10 +00:00
|
|
|
}
|
|
|
|
|
2012-02-03 22:07:47 +00:00
|
|
|
bool chop(double minT1, double maxT1, double minT2, double maxT2, int split) {
|
|
|
|
++depth;
|
2012-01-10 21:46:10 +00:00
|
|
|
intersections.swap();
|
2012-02-03 22:07:47 +00:00
|
|
|
if (split) {
|
|
|
|
++splits;
|
|
|
|
if (split & 2) {
|
|
|
|
double middle1 = (maxT1 + minT1) / 2;
|
|
|
|
intersect(minT1, middle1, minT2, maxT2);
|
|
|
|
intersect(middle1, maxT1, minT2, maxT2);
|
|
|
|
} else {
|
|
|
|
double middle2 = (maxT2 + minT2) / 2;
|
|
|
|
intersect(minT1, maxT1, minT2, middle2);
|
|
|
|
intersect(minT1, maxT1, middle2, maxT2);
|
2012-01-10 21:46:10 +00:00
|
|
|
}
|
2012-02-03 22:07:47 +00:00
|
|
|
--splits;
|
2012-01-10 21:46:10 +00:00
|
|
|
intersections.swap();
|
2012-02-03 22:07:47 +00:00
|
|
|
--depth;
|
2012-01-10 21:46:10 +00:00
|
|
|
return intersections.intersected();
|
|
|
|
}
|
2012-02-03 22:07:47 +00:00
|
|
|
bool result = intersect(minT1, maxT1, minT2, maxT2);
|
2012-01-10 21:46:10 +00:00
|
|
|
intersections.swap();
|
2012-02-03 22:07:47 +00:00
|
|
|
--depth;
|
2012-01-10 21:46:10 +00:00
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2012-02-03 22:07:47 +00:00
|
|
|
private:
|
|
|
|
|
|
|
|
static const double tClipLimit = 0.8; // http://cagd.cs.byu.edu/~tom/papers/bezclip.pdf see Multiple intersections
|
|
|
|
const Cubic& cubic1;
|
|
|
|
const Cubic& cubic2;
|
|
|
|
Intersections& intersections;
|
|
|
|
int depth;
|
|
|
|
int splits;
|
|
|
|
};
|
|
|
|
|
|
|
|
bool intersect(const Cubic& c1, const Cubic& c2, Intersections& i) {
|
|
|
|
CubicIntersections c(c1, c2, i);
|
|
|
|
return c.intersect();
|
2012-01-10 21:46:10 +00:00
|
|
|
}
|
2012-02-03 22:07:47 +00:00
|
|
|
|