gp_XY aVec12 = aSecondPnt - aFirstPnt;
gp_XY aVec23 = aThirdPnt - aSecondPnt;
gp_XY aVec31 = aFirstPnt - aThirdPnt;
+
+ // coefficients to calculate center
+ double aCoeff1, aCoeff2, aCoeff3;
+
// square of parallelogram
double aSquare2 = aVec12.Crossed(aVec23);
aSquare2 *= aSquare2 * 2.0;
- if (aSquare2 < 1.e-20)
- return NULL;
- // coefficients to calculate center
- double aCoeff1 = aVec23.Dot(aVec23) / aSquare2 * aVec12.Dot(aVec31.Reversed());
- double aCoeff2 = aVec31.Dot(aVec31) / aSquare2 * aVec23.Dot(aVec12.Reversed());
- double aCoeff3 = aVec12.Dot(aVec12) / aSquare2 * aVec31.Dot(aVec23.Reversed());
+ if (aSquare2 < 1.e-20) {
+ // if two points are equal, build a circle on two different points as on diameter
+ double aSqLen12 = aVec12.SquareModulus();
+ double aSqLen23 = aVec23.SquareModulus();
+ double aSqLen31 = aVec31.SquareModulus();
+ if (aSqLen12 < Precision::SquareConfusion() &&
+ aSqLen23 < Precision::SquareConfusion() &&
+ aSqLen31 < Precision::SquareConfusion())
+ return NULL;
+ aCoeff1 = aCoeff2 = aCoeff3 = 1.0 / 3.0;
+ }
+ else {
+ aCoeff1 = aVec23.Dot(aVec23) / aSquare2 * aVec12.Dot(aVec31.Reversed());
+ aCoeff2 = aVec31.Dot(aVec31) / aSquare2 * aVec23.Dot(aVec12.Reversed());
+ aCoeff3 = aVec12.Dot(aVec12) / aSquare2 * aVec31.Dot(aVec23.Reversed());
+ }
// center
gp_XY aCenter = aFirstPnt * aCoeff1 + aSecondPnt * aCoeff2 + aThirdPnt * aCoeff3;
// radius
l1 = self.sketch.addLine(0, 0, 0, 1)
l2 = self.sketch.addLine(0, 1, 1, 1)
self.sketch.setCoincident(l1.endPoint(), l2.startPoint())
- self.sketch.setFillet(l1.result(), l2.result(), 10.0)
+ self.sketch.setFillet(l1.endPoint(), 10.0)
model.do()
if __name__ == "__main__":