00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011 #include "CouenneTypes.hpp"
00012 #include "CouennePrecisions.hpp"
00013
00014
00015
00016
00017
00018
00019 CouNumber project (CouNumber a, CouNumber b, CouNumber c,
00020 CouNumber x0, CouNumber y0,
00021 CouNumber lb, CouNumber ub, int sign,
00022 CouNumber *xp, CouNumber *yp) {
00023
00024
00025 register CouNumber
00026 t = - (a*x0 + b*y0 + c);
00027
00028
00029 CouNumber xpr, ypr;
00030
00031
00032 if (fabs (t) < COUENNE_EPS) return 0.;
00033
00034
00035 if (sign > 0) {if (t < 0.) return 0.;}
00036 else if (sign < 0) {if (t > 0.) return 0.;}
00037
00038
00039 t /= sqrt (a*a + b*b);
00040
00041
00042 xpr = x0 + a*t;
00043 ypr = y0 + b*t;
00044
00045
00046 if (t < 0.) t = -t;
00047
00048
00049
00050 if ((xpr < lb) || (xpr > ub)) {
00051
00052 if (xpr < lb) xpr = lb;
00053 else if (xpr > ub) xpr = ub;
00054
00055 ypr = (- c - a * xpr) / b - y0;
00056 xpr -= x0;
00057
00058 t = sqrt (xpr * xpr + ypr * ypr);
00059 }
00060
00061
00062 if (xp) *xp = xpr;
00063 if (yp) *yp = ypr;
00064
00065
00066 return t;
00067 }
00068
00069
00075 CouNumber projectSeg (CouNumber x0, CouNumber y0,
00076 CouNumber x1, CouNumber y1,
00077 CouNumber x2, CouNumber y2,
00078 int sign,
00079 CouNumber *xp, CouNumber *yp) {
00080 CouNumber
00081 dx = x2-x1,
00082 dy = y2-y1,
00083 a = -dy,
00084 b = dx,
00085 c = x1*dy - y1*dx;
00086
00087 return project (a, b, c, x0, y0, x1, x2, sign, xp, yp);
00088 }
00089
00090
00091
00092
00093
00094
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104
00105
00106
00107
00108
00109
00110
00111
00112
00113