0767cd35f8
Fixes a bug where an arc, ellipse, or arc-of-ellipse, being reversed in XY plane, behaved badly in sketcher (see forum thread "Sketch: how to handle reversed external arcs?" http://forum.freecadweb.org/viewtopic.php?f=10&t=9130 ). Also fixes a problem with rotated arcs (see forum thread "Rotating Arc in Sketcher" http://forum.freecadweb.org/viewtopic.php?f=22&t=9145#p74262 ). This is done by adding an emulation flag to a few methods in Part::GeomXXX, which makes the shape to pretend being non-reversed (CCW). This causes endpoints of reversed arcs of circles lineked as external geometry to swap, causing broken sketches sometimes.
227 lines
12 KiB
C++
227 lines
12 KiB
C++
/***************************************************************************
|
|
* Copyright (c) Konstantinos Poulios (logari81@gmail.com) 2011 *
|
|
* *
|
|
* This file is part of the FreeCAD CAx development system. *
|
|
* *
|
|
* This library is free software; you can redistribute it and/or *
|
|
* modify it under the terms of the GNU Library General Public *
|
|
* License as published by the Free Software Foundation; either *
|
|
* version 2 of the License, or (at your option) any later version. *
|
|
* *
|
|
* This library is distributed in the hope that it will be useful, *
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
|
* GNU Library General Public License for more details. *
|
|
* *
|
|
* You should have received a copy of the GNU Library General Public *
|
|
* License along with this library; see the file COPYING.LIB. If not, *
|
|
* write to the Free Software Foundation, Inc., 59 Temple Place, *
|
|
* Suite 330, Boston, MA 02111-1307, USA *
|
|
* *
|
|
***************************************************************************/
|
|
|
|
#ifndef PLANEGCS_GCS_H
|
|
#define PLANEGCS_GCS_H
|
|
|
|
#include "SubSystem.h"
|
|
|
|
namespace GCS
|
|
{
|
|
///////////////////////////////////////
|
|
// BFGS Solver parameters
|
|
///////////////////////////////////////
|
|
#define XconvergenceRough 1e-8
|
|
#define XconvergenceFine 1e-10
|
|
#define smallF 1e-20
|
|
#define MaxIterations 100 //Note that the total number of iterations allowed is MaxIterations *xLength
|
|
|
|
|
|
///////////////////////////////////////
|
|
// Solver
|
|
///////////////////////////////////////
|
|
|
|
enum SolveStatus {
|
|
Success = 0, // Found a solution zeroing the error function
|
|
Converged = 1, // Found a solution minimizing the error function
|
|
Failed = 2 // Failed to find any solution
|
|
};
|
|
|
|
enum Algorithm {
|
|
BFGS = 0,
|
|
LevenbergMarquardt = 1,
|
|
DogLeg = 2
|
|
};
|
|
|
|
class System
|
|
{
|
|
// This is the main class. It holds all constraints and information
|
|
// about partitioning into subsystems and solution strategies
|
|
private:
|
|
VEC_pD plist; // list of the unknown parameters
|
|
MAP_pD_I pIndex;
|
|
|
|
std::vector<Constraint *> clist;
|
|
std::map<Constraint *,VEC_pD > c2p; // constraint to parameter adjacency list
|
|
std::map<double *,std::vector<Constraint *> > p2c; // parameter to constraint adjacency list
|
|
|
|
std::vector<SubSystem *> subSystems, subSystemsAux;
|
|
void clearSubSystems();
|
|
|
|
VEC_D reference;
|
|
void setReference(); // copies the current parameter values to reference
|
|
void resetToReference(); // reverts all parameter values to the stored reference
|
|
|
|
std::vector< VEC_pD > plists; // partitioned plist except equality constraints
|
|
std::vector< std::vector<Constraint *> > clists; // partitioned clist except equality constraints
|
|
std::vector< MAP_pD_pD > reductionmaps; // for simplification of equality constraints
|
|
|
|
int dofs;
|
|
std::set<Constraint *> redundant;
|
|
VEC_I conflictingTags, redundantTags;
|
|
|
|
bool hasUnknowns; // if plist is filled with the unknown parameters
|
|
bool hasDiagnosis; // if dofs, conflictingTags, redundantTags are up to date
|
|
bool isInit; // if plists, clists, reductionmaps are up to date
|
|
|
|
int solve_BFGS(SubSystem *subsys, bool isFine);
|
|
int solve_LM(SubSystem *subsys);
|
|
int solve_DL(SubSystem *subsys);
|
|
public:
|
|
System();
|
|
/*System(std::vector<Constraint *> clist_);*/
|
|
~System();
|
|
|
|
void clear();
|
|
void clearByTag(int tagId);
|
|
|
|
int addConstraint(Constraint *constr);
|
|
void removeConstraint(Constraint *constr);
|
|
|
|
// basic constraints
|
|
int addConstraintEqual(double *param1, double *param2, int tagId=0);
|
|
int addConstraintDifference(double *param1, double *param2,
|
|
double *difference, int tagId=0);
|
|
int addConstraintP2PDistance(Point &p1, Point &p2, double *distance, int tagId=0);
|
|
int addConstraintP2PAngle(Point &p1, Point &p2, double *angle,
|
|
double incrAngle, int tagId=0);
|
|
int addConstraintP2PAngle(Point &p1, Point &p2, double *angle, int tagId=0);
|
|
int addConstraintP2LDistance(Point &p, Line &l, double *distance, int tagId=0);
|
|
int addConstraintPointOnLine(Point &p, Line &l, int tagId=0);
|
|
int addConstraintPointOnLine(Point &p, Point &lp1, Point &lp2, int tagId=0);
|
|
int addConstraintPointOnPerpBisector(Point &p, Line &l, int tagId=0);
|
|
int addConstraintPointOnPerpBisector(Point &p, Point &lp1, Point &lp2, int tagId=0);
|
|
int addConstraintParallel(Line &l1, Line &l2, int tagId=0);
|
|
int addConstraintPerpendicular(Line &l1, Line &l2, int tagId=0);
|
|
int addConstraintPerpendicular(Point &l1p1, Point &l1p2,
|
|
Point &l2p1, Point &l2p2, int tagId=0);
|
|
int addConstraintL2LAngle(Line &l1, Line &l2, double *angle, int tagId=0);
|
|
int addConstraintL2LAngle(Point &l1p1, Point &l1p2, Point &l2p1, Point &l2p2,
|
|
double *angle, int tagId=0);
|
|
int addConstraintAngleViaPoint(Curve &crv1, Curve &crv2, Point &p,
|
|
double *angle, int tagId=0);
|
|
int addConstraintMidpointOnLine(Line &l1, Line &l2, int tagId=0);
|
|
int addConstraintMidpointOnLine(Point &l1p1, Point &l1p2, Point &l2p1, Point &l2p2,
|
|
int tagId=0);
|
|
int addConstraintTangentCircumf(Point &p1, Point &p2, double *rd1, double *rd2,
|
|
bool internal=false, int tagId=0);
|
|
|
|
// derived constraints
|
|
int addConstraintP2PCoincident(Point &p1, Point &p2, int tagId=0);
|
|
int addConstraintHorizontal(Line &l, int tagId=0);
|
|
int addConstraintHorizontal(Point &p1, Point &p2, int tagId=0);
|
|
int addConstraintVertical(Line &l, int tagId=0);
|
|
int addConstraintVertical(Point &p1, Point &p2, int tagId=0);
|
|
int addConstraintCoordinateX(Point &p, double *x, int tagId=0);
|
|
int addConstraintCoordinateY(Point &p, double *y, int tagId=0);
|
|
int addConstraintArcRules(Arc &a, int tagId=0);
|
|
int addConstraintPointOnCircle(Point &p, Circle &c, int tagId=0);
|
|
int addConstraintPointOnEllipse(Point &p, Ellipse &e, int tagId=0);
|
|
int addConstraintEllipticalArcRangeToEndPoints(Point &p, ArcOfEllipse &a, double *angle, int tagId=0);
|
|
int addConstraintArcOfEllipseRules(ArcOfEllipse &a, int tagId=0);
|
|
int addConstraintPointOnArc(Point &p, Arc &a, int tagId=0);
|
|
int addConstraintPerpendicularLine2Arc(Point &p1, Point &p2, Arc &a,
|
|
int tagId=0);
|
|
int addConstraintPerpendicularArc2Line(Arc &a, Point &p1, Point &p2,
|
|
int tagId=0);
|
|
int addConstraintPerpendicularCircle2Arc(Point ¢er, double *radius, Arc &a,
|
|
int tagId=0);
|
|
int addConstraintPerpendicularArc2Circle(Arc &a, Point ¢er, double *radius,
|
|
int tagId=0);
|
|
int addConstraintPerpendicularArc2Arc(Arc &a1, bool reverse1,
|
|
Arc &a2, bool reverse2, int tagId=0);
|
|
int addConstraintTangent(Line &l, Circle &c, int tagId=0);
|
|
int addConstraintTangent(Line &l, Ellipse &e, int tagId=0);
|
|
int addConstraintTangent(Line &l, Arc &a, int tagId=0);
|
|
int addConstraintTangent(Circle &c1, Circle &c2, int tagId=0);
|
|
int addConstraintTangent(Arc &a1, Arc &a2, int tagId=0);
|
|
int addConstraintTangent(Circle &c, Arc &a, int tagId=0);
|
|
|
|
int addConstraintCircleRadius(Circle &c, double *radius, int tagId=0);
|
|
int addConstraintArcRadius(Arc &a, double *radius, int tagId=0);
|
|
int addConstraintEqualLength(Line &l1, Line &l2, double *length, int tagId=0);
|
|
int addConstraintEqualRadius(Circle &c1, Circle &c2, int tagId=0);
|
|
int addConstraintEqualRadii(Ellipse &e1, Ellipse &e2, int tagId=0);
|
|
int addConstraintEqualRadius(Circle &c1, Arc &a2, int tagId=0);
|
|
int addConstraintEqualRadius(Arc &a1, Arc &a2, int tagId=0);
|
|
int addConstraintP2PSymmetric(Point &p1, Point &p2, Line &l, int tagId=0);
|
|
int addConstraintP2PSymmetric(Point &p1, Point &p2, Point &p, int tagId=0);
|
|
int addConstraintSnellsLaw(Curve &ray1, Curve &ray2,
|
|
Curve &boundary, Point p,
|
|
double* n1, double* n2,
|
|
bool flipn1, bool flipn2,
|
|
int tagId);
|
|
|
|
// internal alignment constraints
|
|
int addConstraintInternalAlignmentPoint2Ellipse(Ellipse &e, Point &p1, InternalAlignmentType alignmentType, int tagId=0);
|
|
int addConstraintInternalAlignmentEllipseMajorDiameter(Ellipse &e, Point &p1, Point &p2, int tagId=0);
|
|
int addConstraintInternalAlignmentEllipseMinorDiameter(Ellipse &e, Point &p1, Point &p2, int tagId=0);
|
|
int addConstraintInternalAlignmentEllipseFocus1(Ellipse &e, Point &p1, int tagId=0);
|
|
int addConstraintInternalAlignmentEllipseFocus2(Ellipse &e, Point &p1, int tagId=0);
|
|
|
|
double calculateAngleViaPoint(Curve &crv1, Curve &crv2, Point &p);
|
|
double calculateAngleViaPoint(Curve &crv1, Curve &crv2, Point &p1, Point &p2);
|
|
void calculateNormalAtPoint(Curve &crv, Point &p, double &rtnX, double &rtnY);
|
|
|
|
// Calculates errors of all constraints which have a tag equal to
|
|
// the one supplied. Individual errors are summed up using RMS.
|
|
// If none are found, NAN is returned
|
|
// If there's only one, a signed value is returned.
|
|
// Effectively, it calculates the error of a UI constraint
|
|
double calculateConstraintErrorByTag(int tagId);
|
|
|
|
void rescaleConstraint(int id, double coeff);
|
|
|
|
void declareUnknowns(VEC_pD ¶ms);
|
|
void initSolution();
|
|
|
|
int solve(bool isFine=true, Algorithm alg=DogLeg);
|
|
int solve(VEC_pD ¶ms, bool isFine=true, Algorithm alg=DogLeg);
|
|
int solve(SubSystem *subsys, bool isFine=true, Algorithm alg=DogLeg);
|
|
int solve(SubSystem *subsysA, SubSystem *subsysB, bool isFine=true);
|
|
|
|
void applySolution();
|
|
void undoSolution();
|
|
|
|
double getFinePrecision(){ return XconvergenceFine;}//FIXME: looks like XconvergenceFine is not the solver precision, at least in DogLeg slover.
|
|
|
|
int diagnose();
|
|
int dofsNumber() { return hasDiagnosis ? dofs : -1; }
|
|
void getConflicting(VEC_I &conflictingOut) const
|
|
{ conflictingOut = hasDiagnosis ? conflictingTags : VEC_I(0); }
|
|
void getRedundant(VEC_I &redundantOut) const
|
|
{ redundantOut = hasDiagnosis ? redundantTags : VEC_I(0); }
|
|
};
|
|
|
|
|
|
///////////////////////////////////////
|
|
// Helper elements
|
|
///////////////////////////////////////
|
|
|
|
void free(VEC_pD &doublevec);
|
|
void free(std::vector<Constraint *> &constrvec);
|
|
void free(std::vector<SubSystem *> &subsysvec);
|
|
|
|
} //namespace GCS
|
|
|
|
#endif // PLANEGCS_GCS_H
|