710 lines
19 KiB
C++
710 lines
19 KiB
C++
|
|
|
|
// TnzCore includes
|
|
#include "tmathutil.h"
|
|
#include "tcurves.h"
|
|
#include "tbezier.h"
|
|
#include "tstrokedeformations.h"
|
|
#include "tstroke.h"
|
|
#include "tcurveutil.h"
|
|
#include "tcg_wrap.h"
|
|
|
|
// tcg includes
|
|
#include "tcg/tcg_poly_ops.h"
|
|
|
|
#define INCLUDE_HPP
|
|
#include "tcg/tcg_polylineops.h"
|
|
#include "tcg/tcg_cyclic.h"
|
|
#undef INCLUDE_HPP
|
|
|
|
#include "tstrokeutil.h"
|
|
|
|
//*********************************************************************************
|
|
// Local namespace stuff
|
|
//*********************************************************************************
|
|
|
|
namespace
|
|
{
|
|
|
|
typedef vector<TThickCubic *> TThickCubicArray;
|
|
typedef vector<TThickQuadratic *> QuadStrokeChunkArray;
|
|
|
|
//---------------------------------------------------------------------------
|
|
|
|
int getControlPointIndex(const TStroke &stroke,
|
|
double w)
|
|
{
|
|
TThickPoint p = stroke.getControlPointAtParameter(w);
|
|
|
|
int i = 0;
|
|
int controlPointCount = stroke.getControlPointCount();
|
|
|
|
for (; i < controlPointCount; ++i)
|
|
if (stroke.getControlPoint(i) == p)
|
|
return i;
|
|
|
|
return controlPointCount - 1;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
|
|
double findMinimum(const TStrokeDeformation &def,
|
|
const TStroke &stroke,
|
|
double x1,
|
|
double x2,
|
|
double xacc,
|
|
double length = 0,
|
|
int max_iter = 100)
|
|
|
|
{
|
|
int j;
|
|
double dx, f, fmid, xmid, rtb;
|
|
|
|
f = def.getDelta(stroke, x1) - length;
|
|
fmid = def.getDelta(stroke, x2) - length;
|
|
|
|
if (f == 0)
|
|
return x1;
|
|
if (fmid == 0)
|
|
return x2;
|
|
|
|
if (f * fmid > 0.0)
|
|
return -1;
|
|
|
|
rtb = f < 0.0 ? (dx = x2 - x1, x1) : (dx = x1 - x2, x2);
|
|
|
|
for (j = 1; j <= max_iter; j++) {
|
|
fmid = def.getDelta(stroke, xmid = rtb + (dx *= 0.5)) - length;
|
|
if (fmid <= 0.0)
|
|
rtb = xmid;
|
|
if (fabs(dx) < xacc || fmid == 0.0)
|
|
return rtb;
|
|
}
|
|
return -2;
|
|
}
|
|
|
|
//---------------------------------------------------------------------------
|
|
|
|
/**
|
|
* Rationale:
|
|
* Supponiamo di voler modellare un segmento (rappresentato da una stroke)
|
|
* in modo che assuma la forma di una parabola (caso abituale offerto dal modificatore).
|
|
* Poniamo il che:
|
|
* (o) i punti della stroke si trovino lungo l'asse y=-100;
|
|
* (o) le x che corrisponderanno siano x1=-10 e x2=+10 (ovvio dall'equazione).
|
|
*
|
|
* La parabola potrà essere rappresentata sul lato sx da una quadratica con
|
|
* punti di controllo:
|
|
* P0=(-10,-100),
|
|
* P1=(-5, 0),
|
|
* P2=( 0, 0).
|
|
* Se conosciamo il numero di tratti lineari che rappresentano questa parabola,
|
|
* sappiamo anche quanti "campioni" sono richiesti per la sua linearizzazione.
|
|
* Questo parametro può essere utilizzato per stabilire in modo qualitativo
|
|
* il valore con cui campionare la stroke da testare; ci dovranno essere tanti
|
|
* punti da spostare per quanti campioni sono presenti nel riferimento.
|
|
*/
|
|
double
|
|
computeIncrement(double strokeLength,
|
|
double pixelSize)
|
|
{
|
|
assert(pixelSize > 0 && "Pixel size is negative!!!");
|
|
assert(strokeLength > 0 && "Stroke Length size is negative!!!");
|
|
|
|
// altezza della parabola (va verso il basso)
|
|
double
|
|
height = 100;
|
|
|
|
// suppongo di fare almeno un drag di 100 pixel
|
|
assert(height >= 100.0);
|
|
|
|
double
|
|
x = sqrt(height);
|
|
|
|
// il punto p1 dovra' essere all'intersezione
|
|
// tra le tangenti ai due estremi.
|
|
// La tangente del punto p2 e l'asse x,
|
|
// l'altra avra' versore dato dal gradiente in p0,
|
|
// cioe': grad(x,-2 x)
|
|
// e se y = m x + q
|
|
// m =
|
|
double
|
|
m = 2.0 * x;
|
|
|
|
double
|
|
q = m * x - height;
|
|
|
|
double
|
|
p1x = q / m;
|
|
|
|
double
|
|
scale = strokeLength / (2.0 * x);
|
|
|
|
TScale
|
|
scaleAffine(scale, scale);
|
|
|
|
TPointD
|
|
p0 = scaleAffine * TPointD(-x, -height),
|
|
p1 = scaleAffine * TPointD(-p1x, 0.0),
|
|
p2 = scaleAffine * TPointD(0.0, 0.0);
|
|
|
|
TQuadratic
|
|
quadratic(p0,
|
|
p1,
|
|
p2);
|
|
|
|
double
|
|
step = computeStep(quadratic,
|
|
pixelSize);
|
|
|
|
// giusto per aggiungere punti anche nel caso peggiore.
|
|
if (step >= 1.0)
|
|
step = 0.1;
|
|
|
|
return step;
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
void detectEdges(const vector<TPointD> &pointArray, vector<UINT> &edgeIndexArray)
|
|
{
|
|
// ASSUNZIONE: sharpPointArray non contiene punti coincidenti adiacenti
|
|
|
|
int size = pointArray.size();
|
|
// controllo che ci siano piu' di tre elementi
|
|
if (size < 3)
|
|
return;
|
|
// scorre pointArray e per ogni suo punto cerca di inscrivere triangoli (utilizzando i
|
|
// punti a sinistra e a destra) considerando potenziali corner quelli con lati l tale
|
|
// che dMin <= l <= dMax (in realta' alla prima volta che l > dMax: breack) e con apertura
|
|
// angolare alpha <= alphaMax. Poi cerca i max locali tra i potenziali corner in una
|
|
// finestra di semiampiezza dMax (al solito alla prima volta che si supera dMax: breack)
|
|
|
|
// valori di default: dMin = 7; dMax = dMin + 2; alphaMax = 2.6 (150°)
|
|
|
|
const double dMin = 4;
|
|
const double dMax = dMin + 3;
|
|
const double alphaMax = 2.4; // ( 137.5°)
|
|
const double dMin2 = dMin * dMin;
|
|
const double dMax2 = dMax * dMax;
|
|
vector<double> sharpnessArray;
|
|
sharpnessArray.push_back(TConsts::pi); // il primo punto e' un corner
|
|
int nodeCount;
|
|
for (nodeCount = 1; nodeCount < size - 1; ++nodeCount) { // scorre la sharpPointArray escludendo gli estremi
|
|
sharpnessArray.push_back(0);
|
|
TPointD point(pointArray[nodeCount]);
|
|
int leftCount;
|
|
for (leftCount = nodeCount - 1; leftCount >= 0; --leftCount) { // calcola i lati "left" dei triangoli inscritti...
|
|
TPointD left = pointArray[leftCount];
|
|
double dLeft2 = norm2(left - point);
|
|
if (dLeft2 < dMin2)
|
|
continue;
|
|
else if (dLeft2 > dMax2)
|
|
break;
|
|
int rightCount;
|
|
for (rightCount = nodeCount + 1; rightCount < size; ++rightCount) { // calcola i lati "right" dei triangoli inscritti...
|
|
TPointD right = pointArray[rightCount];
|
|
double dRight2 = norm2(right - point);
|
|
if (dRight2 < dMin2)
|
|
continue;
|
|
else if (dMax2 < dRight2)
|
|
break;
|
|
|
|
// calcola i lati "center" dei triangoli inscritti
|
|
double dCenter2 = norm2(left - right);
|
|
assert(dLeft2 != 0.0 && dRight2 != 0.0);
|
|
|
|
double cs = (dLeft2 + dRight2 - dCenter2) / (2 * sqrt(dLeft2 * dRight2));
|
|
double alpha = acos(cs);
|
|
if (alpha > alphaMax)
|
|
continue;
|
|
|
|
double sharpness = TConsts::pi - alpha;
|
|
|
|
if (sharpnessArray[nodeCount] < sharpness)
|
|
sharpnessArray[nodeCount] = sharpness;
|
|
}
|
|
}
|
|
}
|
|
|
|
edgeIndexArray.push_back(0); // il primo punto e' un corner
|
|
|
|
// trovo i massimi locali escludendo gli estremi
|
|
for (nodeCount = 1; nodeCount < size - 1; ++nodeCount) { // scorre la lista escludendo gli estremi
|
|
bool isCorner = true;
|
|
TPointD point(pointArray[nodeCount]);
|
|
int leftCount;
|
|
for (leftCount = nodeCount - 1; leftCount >= 0; --leftCount) { // scorre la lista di sharpPoint a sinistra di node...
|
|
TPointD left = pointArray[leftCount];
|
|
double dLeft2 = norm2(left - point);
|
|
if (dLeft2 > dMax2)
|
|
break;
|
|
if (sharpnessArray[leftCount] > sharpnessArray[nodeCount]) {
|
|
isCorner = false;
|
|
break;
|
|
}
|
|
}
|
|
if (isCorner)
|
|
continue;
|
|
int rightCount;
|
|
for (rightCount = nodeCount + 1; rightCount < size; ++rightCount) { // scorre la lista di sharpPoint a destra di node..
|
|
TPointD right = pointArray[rightCount];
|
|
double dRight2 = norm2(right - point);
|
|
if (dRight2 > dMax2)
|
|
break;
|
|
if (sharpnessArray[rightCount] > sharpnessArray[nodeCount]) {
|
|
isCorner = false;
|
|
break;
|
|
}
|
|
}
|
|
if (isCorner)
|
|
edgeIndexArray.push_back(nodeCount);
|
|
}
|
|
edgeIndexArray.push_back(size - 1); // l'ultimo punto e' un corner
|
|
}
|
|
|
|
} // namespace
|
|
|
|
//*******************************************************************************
|
|
// API functions
|
|
//*******************************************************************************
|
|
|
|
bool increaseControlPoints(TStroke &stroke,
|
|
const TStrokeDeformation &deformer,
|
|
double pixelSize)
|
|
{
|
|
|
|
if (isAlmostZero(stroke.getLength())) {
|
|
return norm2(deformer.getDisplacement(stroke, 0.0)) > 0;
|
|
}
|
|
|
|
// step 1:
|
|
// It's possible to have control point at not null potential
|
|
// but with delta equal 0 (equipotential control point)
|
|
bool notVoidPotential = false;
|
|
|
|
for (int i = 0; i < stroke.getControlPointCount(); ++i) {
|
|
double par = stroke.getParameterAtControlPoint(i);
|
|
if (deformer.getDisplacement(stroke, par) != TThickPoint()) {
|
|
notVoidPotential = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
// step 2:
|
|
// increase control point checking delta of deformer
|
|
double maxDifference = deformer.getMaxDiff(); //sopra questo valore di delta, si aggiungono punti
|
|
|
|
int strokeControlPoint = stroke.getControlPointCount();
|
|
|
|
// pixelSize = sq( pixelSize );
|
|
|
|
if (pixelSize < TConsts::epsilon)
|
|
pixelSize = TConsts::epsilon;
|
|
|
|
double
|
|
length = stroke.getLength(),
|
|
// set the step function of length
|
|
// step = length > 1.0 ? pixelSize * 15.0/ length : length,
|
|
//step = 0.01,
|
|
w = 0.0;
|
|
|
|
double
|
|
step = computeIncrement(length,
|
|
pixelSize);
|
|
|
|
double x1, x2, d1, d2, diff, offset, minimum, incr;
|
|
|
|
incr = step;
|
|
|
|
while (w + incr < 1.0) {
|
|
d1 = deformer.getDelta(stroke, w);
|
|
d2 = deformer.getDelta(stroke, w + incr);
|
|
|
|
diff = d2 - d1;
|
|
|
|
if (fabs(diff) >= maxDifference) // if there is a step of potential
|
|
{
|
|
if (tsign(diff) > 0) {
|
|
x1 = w;
|
|
x2 = w + incr;
|
|
} else {
|
|
x1 = w + incr;
|
|
x2 = w;
|
|
}
|
|
|
|
offset = (d1 + d2) * 0.5;
|
|
|
|
// find the position of step
|
|
minimum = findMinimum(deformer, stroke, x1, x2, TConsts::epsilon, offset, 20); //tra x1 e x2 va messo un nuovo punto di controllo. dove?
|
|
//questa funzione trova il punto in cui si supera il valore maxdifference
|
|
|
|
// if minimum is not found or is equal to previous value
|
|
// use an euristic...
|
|
if (minimum < 0 || w == minimum) {
|
|
minimum = w + incr * 0.5;
|
|
w += step;
|
|
}
|
|
|
|
//... else insert a control point in minimum
|
|
w = minimum; //la scansione riprende dal nuovo punto, in questo modo si infittisce...
|
|
stroke.insertControlPoints(minimum);
|
|
|
|
// update of step
|
|
incr = step;
|
|
} else
|
|
incr += step;
|
|
}
|
|
|
|
// return true if control point are increased
|
|
return (stroke.getControlPointCount() > strokeControlPoint) || notVoidPotential;
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
void modifyControlPoints(TStroke &stroke,
|
|
const TStrokeDeformation &deformer)
|
|
{
|
|
int cpCount = stroke.getControlPointCount();
|
|
|
|
TThickPoint newP;
|
|
|
|
for (int i = 0; i < cpCount; ++i) {
|
|
newP = stroke.getControlPoint(i) + deformer.getDisplacementForControlPoint(stroke, i);
|
|
if (isAlmostZero(newP.thick, 0.005))
|
|
newP.thick = 0;
|
|
stroke.setControlPoint(i, newP);
|
|
}
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
void modifyControlPoints(TStroke &stroke,
|
|
const TStrokeDeformation &deformer, vector<double> &controlPointLen)
|
|
{
|
|
UINT cpCount = stroke.getControlPointCount();
|
|
|
|
TThickPoint newP;
|
|
|
|
#ifdef _DEBUG
|
|
UINT debugVariable = controlPointLen.size();
|
|
#endif
|
|
assert(controlPointLen.size() == cpCount);
|
|
|
|
for (UINT i = 0; i < cpCount; ++i) {
|
|
newP = stroke.getControlPoint(i) + deformer.getDisplacementForControlPointLen(stroke, controlPointLen[i]);
|
|
if (isAlmostZero(newP.thick, 0.005))
|
|
newP.thick = 0;
|
|
stroke.setControlPoint(i, newP);
|
|
}
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
void modifyThickness(TStroke &stroke, const TStrokeDeformation &deformer,
|
|
vector<double> &controlPointLen, bool exponentially)
|
|
{
|
|
UINT cpCount = stroke.getControlPointCount();
|
|
assert(controlPointLen.size() == cpCount);
|
|
|
|
double disp;
|
|
double thick;
|
|
|
|
for (UINT i = 0; i < cpCount; ++i) {
|
|
disp = (deformer.getDisplacementForControlPointLen(stroke, controlPointLen[i])).thick;
|
|
|
|
thick = stroke.getControlPoint(i).thick;
|
|
|
|
//The additive version is straightforward.
|
|
//The exponential version is devised to keep derivative 1 at disp == 0;
|
|
//it is typically used when the thickness decreases.
|
|
|
|
thick = (exponentially && thick >= 0.005) ? thick * exp(disp / thick) : thick + disp;
|
|
|
|
if (thick < 0.005)
|
|
thick = 0.0;
|
|
|
|
stroke.setControlPoint(i, TThickPoint(stroke.getControlPoint(i), thick));
|
|
}
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
void transform_thickness(TStroke &stroke, const double poly[], int deg)
|
|
{
|
|
int cp, cpCount = stroke.getControlPointCount();
|
|
for (cp = 0; cp != cpCount; ++cp) {
|
|
TThickPoint cpPoint = stroke.getControlPoint(cp);
|
|
cpPoint.thick = tmax(
|
|
tcg::poly_ops::evaluate(poly, deg, cpPoint.thick),
|
|
0.0);
|
|
|
|
stroke.setControlPoint(cp, cpPoint);
|
|
}
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
TStroke *Toonz::merge(const std::vector<TStroke *> &strokes)
|
|
{
|
|
if (strokes.empty())
|
|
return 0;
|
|
|
|
std::vector<TThickPoint>
|
|
new_stroke_cp;
|
|
|
|
int
|
|
size_stroke_array = strokes.size();
|
|
|
|
int
|
|
size_cp;
|
|
|
|
const TStroke *
|
|
ref;
|
|
|
|
TThickPoint
|
|
last = TConsts::natp;
|
|
|
|
if (!strokes[0])
|
|
return 0;
|
|
|
|
new_stroke_cp.push_back(strokes[0]->getControlPoint(0));
|
|
int i, j;
|
|
for (i = 0;
|
|
i < size_stroke_array;
|
|
i++) {
|
|
ref = strokes[i];
|
|
if (!ref)
|
|
return 0;
|
|
|
|
size_cp = ref->getControlPointCount();
|
|
for (j = 0;
|
|
j < size_cp - 1;
|
|
j++) {
|
|
const TThickPoint &
|
|
pnt = ref->getControlPoint(j);
|
|
|
|
if (last != TConsts::natp &&
|
|
j == 0) {
|
|
//new_stroke_cp.push_back( (last+pnt)*0.5 );
|
|
new_stroke_cp.push_back(last);
|
|
}
|
|
|
|
if (j > 0)
|
|
new_stroke_cp.push_back(pnt);
|
|
}
|
|
// last point needs to be merged
|
|
last = ref->getControlPoint(size_cp - 1);
|
|
}
|
|
|
|
new_stroke_cp.push_back(ref->getControlPoint(size_cp - 1));
|
|
|
|
TStroke *out = new TStroke(new_stroke_cp);
|
|
return out;
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
namespace
|
|
{
|
|
|
|
class CpsReader
|
|
{
|
|
std::vector<TThickPoint> &m_cps;
|
|
|
|
public:
|
|
typedef TPointD value_type;
|
|
|
|
public:
|
|
CpsReader(std::vector<TThickPoint> &cps) : m_cps(cps) {}
|
|
|
|
void openContainer(const TPointD &point) { addElement(point); }
|
|
void addElement(const TPointD &point) { m_cps.push_back(TThickPoint(point, 0.0)); }
|
|
void closeContainer() {}
|
|
};
|
|
|
|
//===========================================================
|
|
// Triplet to Quadratics
|
|
//===========================================================
|
|
|
|
template <typename iter_type>
|
|
double buildLength(const iter_type &begin, const iter_type &end, double tol)
|
|
{
|
|
//Build direction
|
|
iter_type it = begin, jt;
|
|
++it;
|
|
|
|
const TPointD &a = *begin, &b = *it;
|
|
|
|
TPointD dir(normalize(b - a)), segDir;
|
|
double dist;
|
|
|
|
for (jt = it, ++it; it != end; jt = it, ++it) {
|
|
segDir = *it - *jt;
|
|
if (dir * segDir < 0)
|
|
break;
|
|
|
|
dist = tcg::point_ops::lineSignedDist(*it, a, dir);
|
|
if (fabs(dist) > tol) {
|
|
double s, t;
|
|
if (dist > 0) {
|
|
tcg::point_ops::intersectionCoords(*jt, segDir,
|
|
a + tol * tcg::point_ops::ortLeft(dir), dir, s, t);
|
|
} else {
|
|
tcg::point_ops::intersectionCoords(*jt, segDir,
|
|
a + tol * tcg::point_ops::ortRight(dir), dir, s, t);
|
|
}
|
|
|
|
s = tcrop(s, 0.0, 1.0);
|
|
return (*jt + s * segDir - a) * dir;
|
|
}
|
|
}
|
|
|
|
return (*jt - a) * dir;
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
/*
|
|
Converts the specified points triplet into a sequence of quadratics' CPs (point
|
|
a is not included, whereas c is).
|
|
|
|
Conversion takes 4 parameters:
|
|
|
|
- Adherence: How much quadratics bend toward corners
|
|
- Angle: Inner product of corner's edges - full corners threshold
|
|
- Relative: Curvature radius/edge length - full corners threshold
|
|
- RelativeDist: Tolerance about edge length build-ups
|
|
|
|
See below for extended explanation.
|
|
*/
|
|
|
|
class TripletsConverter
|
|
{
|
|
typedef std::vector<TPointD>::const_iterator iter_type;
|
|
typedef std::reverse_iterator<iter_type> riter_type;
|
|
typedef tcg::cyclic_iterator<iter_type> cyclic_iter_type;
|
|
typedef std::reverse_iterator<cyclic_iter_type> rcyclic_iter_type;
|
|
|
|
bool m_circular;
|
|
iter_type m_first, m_end, m_last;
|
|
double m_adherenceTol, m_angleTol, m_relativeTol, m_relativeDistTol;
|
|
|
|
public:
|
|
TripletsConverter(const iter_type &begin, const iter_type &end,
|
|
double adherenceTol, double angleTol,
|
|
double relativeTol, double relativeDistTol)
|
|
: m_circular(*begin == *(end - 1)), m_first(m_circular ? begin + 1 : begin), m_end(end), m_adherenceTol(adherenceTol), m_angleTol(angleTol), m_relativeTol(relativeTol), m_relativeDistTol(relativeDistTol) {}
|
|
|
|
//Using bisector to convert a triplet
|
|
void operator()(const TPointD &a, const iter_type &bt, const TPointD &c,
|
|
tcg::sequential_reader<std::vector<TPointD>> &output)
|
|
{
|
|
const TPointD &b = *bt;
|
|
|
|
double prod = tcg::point_ops::direction(b, a) * tcg::point_ops::direction(b, c);
|
|
|
|
if (prod > m_angleTol) {
|
|
//Full corner
|
|
output.addElement(0.5 * (a + b));
|
|
output.addElement(b);
|
|
output.addElement(0.5 * (b + c));
|
|
} else {
|
|
//Build the angle bisector
|
|
TPointD a_b(a - b);
|
|
TPointD c_b(c - b);
|
|
|
|
double norm_a_b = norm(a_b);
|
|
double norm_c_b = norm(c_b);
|
|
|
|
a_b = a_b * (1.0 / norm_a_b);
|
|
c_b = c_b * (1.0 / norm_c_b);
|
|
|
|
TPointD v(tcg::point_ops::normalized(a_b + c_b));
|
|
double cos_v_dir = fabs(a_b * v);
|
|
|
|
double t1 = tcrop(m_adherenceTol / (cos_v_dir * norm_a_b), 0.0, 0.5);
|
|
double t2 = tcrop(m_adherenceTol / (cos_v_dir * norm_c_b), 0.0, 0.5);
|
|
|
|
if (t1 == 0.5 && t2 == 0.5) {
|
|
//Direct conversion
|
|
output.addElement(b);
|
|
} else {
|
|
//Build the quadratic split
|
|
TPointD d(b + t1 * (a - b)), f(b + t2 * (c - b)), e(0.5 * (d + f));
|
|
|
|
//Build curvature radiuses at the corner
|
|
|
|
//NOTE: Both speed and acceleration would hold 2.0 as multiplier, which
|
|
//is calculated implicitly.
|
|
|
|
TPointD speed(f - d);
|
|
|
|
double num = norm(speed);
|
|
if (num <= TConsts::epsilon) {
|
|
//Curvature radius is 0 - full corner
|
|
output.addElement(0.5 * (a + b));
|
|
output.addElement(b);
|
|
output.addElement(0.5 * (b + c));
|
|
} else {
|
|
num = 2.0 * num * num * num; // would be * 8 = 2^3, divided by the 4 below
|
|
|
|
double den1 = fabs(cross(speed, a - d)); // * 4, from both args of the cross
|
|
double den2 = fabs(cross(speed, c - f));
|
|
|
|
double radius1 = (den1 == 0.0) ? 0.0 : num / den1;
|
|
double radius2 = (den1 == 0.0) ? 0.0 : num / den2;
|
|
|
|
//Build edges length
|
|
double length1, length2;
|
|
if (m_circular) {
|
|
cyclic_iter_type it(bt, m_first, m_end, 0);
|
|
cyclic_iter_type it1(bt, m_first, m_end, 1);
|
|
cyclic_iter_type it_1(bt, m_first, m_end, -1);
|
|
rcyclic_iter_type rit(it + 1), rit1(it_1 + 1);
|
|
|
|
length1 = buildLength(rit, rit1, 0.25);
|
|
length2 = buildLength(it, it1, 0.25);
|
|
} else {
|
|
riter_type rit(bt + 1), rend(m_first);
|
|
|
|
length1 = buildLength(rit, rend, m_relativeDistTol);
|
|
length2 = buildLength(bt, m_end, m_relativeDistTol);
|
|
}
|
|
|
|
//Test curvature radiuses against edge length
|
|
if (radius1 / length1 < m_relativeTol && // both must hold
|
|
radius2 / length2 < m_relativeTol) {
|
|
//Full corner
|
|
output.addElement(0.5 * (a + b));
|
|
output.addElement(b);
|
|
output.addElement(0.5 * (b + c));
|
|
} else {
|
|
//Quadratic split
|
|
output.addElement(d);
|
|
output.addElement(e);
|
|
output.addElement(f);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
output.addElement(c);
|
|
}
|
|
};
|
|
|
|
} //namespace
|
|
|
|
//-----------------------------------------------------------------------------
|
|
|
|
void polylineToQuadratics(const std::vector<TPointD> &polyline,
|
|
std::vector<TThickPoint> &cps,
|
|
double adherenceTol, double angleTol,
|
|
double relativeTol, double relativeDistTol,
|
|
double mergeTol)
|
|
{
|
|
CpsReader cpsReader(cps);
|
|
TripletsConverter op(polyline.begin(), polyline.end(),
|
|
adherenceTol, angleTol, relativeTol, relativeDistTol);
|
|
tcg::polyline_ops::toQuadratics(polyline.begin(), polyline.end(), cpsReader, op, mergeTol);
|
|
}
|