caryclark@google.com | 9e49fb6 | 2012-08-27 14:11:33 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2012 Google Inc. |
| 3 | * |
| 4 | * Use of this source code is governed by a BSD-style license that can be |
| 5 | * found in the LICENSE file. |
| 6 | */ |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 7 | #include "CurveIntersection.h" |
| 8 | #include "CubicUtilities.h" |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 9 | |
| 10 | /* from http://tom.cs.byu.edu/~tom/papers/cvgip84.pdf 4.1 |
| 11 | * |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 12 | * This paper proves that Syvester's method can compute the implicit form of |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 13 | * the quadratic from the parameterzied form. |
| 14 | * |
| 15 | * Given x = a*t*t*t + b*t*t + c*t + d (the parameterized form) |
| 16 | * y = e*t*t*t + f*t*t + g*t + h |
| 17 | * |
| 18 | * we want to find an equation of the implicit form: |
| 19 | * |
| 20 | * A*x^3 + B*x*x*y + C*x*y*y + D*y^3 + E*x*x + F*x*y + G*y*y + H*x + I*y + J = 0 |
| 21 | * |
| 22 | * The implicit form can be expressed as a 6x6 determinant, as shown. |
| 23 | * |
| 24 | * The resultant obtained by Syvester's method is |
| 25 | * |
| 26 | * | a b c (d - x) 0 0 | |
| 27 | * | 0 a b c (d - x) 0 | |
| 28 | * | 0 0 a b c (d - x) | |
| 29 | * | e f g (h - y) 0 0 | |
| 30 | * | 0 e f g (h - y) 0 | |
| 31 | * | 0 0 e f g (h - y) | |
| 32 | * |
| 33 | * which, according to Mathematica, expands as shown below. |
| 34 | * |
| 35 | * Resultant[a*t^3 + b*t^2 + c*t + d - x, e*t^3 + f*t^2 + g*t + h - y, t] |
| 36 | * |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 37 | * -d^3 e^3 + c d^2 e^2 f - b d^2 e f^2 + a d^2 f^3 - c^2 d e^2 g + |
| 38 | * 2 b d^2 e^2 g + b c d e f g - 3 a d^2 e f g - a c d f^2 g - |
| 39 | * b^2 d e g^2 + 2 a c d e g^2 + a b d f g^2 - a^2 d g^3 + c^3 e^2 h - |
| 40 | * 3 b c d e^2 h + 3 a d^2 e^2 h - b c^2 e f h + 2 b^2 d e f h + |
| 41 | * a c d e f h + a c^2 f^2 h - 2 a b d f^2 h + b^2 c e g h - |
| 42 | * 2 a c^2 e g h - a b d e g h - a b c f g h + 3 a^2 d f g h + |
| 43 | * a^2 c g^2 h - b^3 e h^2 + 3 a b c e h^2 - 3 a^2 d e h^2 + |
| 44 | * a b^2 f h^2 - 2 a^2 c f h^2 - a^2 b g h^2 + a^3 h^3 + 3 d^2 e^3 x - |
| 45 | * 2 c d e^2 f x + 2 b d e f^2 x - 2 a d f^3 x + c^2 e^2 g x - |
| 46 | * 4 b d e^2 g x - b c e f g x + 6 a d e f g x + a c f^2 g x + |
| 47 | * b^2 e g^2 x - 2 a c e g^2 x - a b f g^2 x + a^2 g^3 x + |
| 48 | * 3 b c e^2 h x - 6 a d e^2 h x - 2 b^2 e f h x - a c e f h x + |
| 49 | * 2 a b f^2 h x + a b e g h x - 3 a^2 f g h x + 3 a^2 e h^2 x - |
| 50 | * 3 d e^3 x^2 + c e^2 f x^2 - b e f^2 x^2 + a f^3 x^2 + |
| 51 | * 2 b e^2 g x^2 - 3 a e f g x^2 + 3 a e^2 h x^2 + e^3 x^3 - |
| 52 | * c^3 e^2 y + 3 b c d e^2 y - 3 a d^2 e^2 y + b c^2 e f y - |
| 53 | * 2 b^2 d e f y - a c d e f y - a c^2 f^2 y + 2 a b d f^2 y - |
| 54 | * b^2 c e g y + 2 a c^2 e g y + a b d e g y + a b c f g y - |
| 55 | * 3 a^2 d f g y - a^2 c g^2 y + 2 b^3 e h y - 6 a b c e h y + |
| 56 | * 6 a^2 d e h y - 2 a b^2 f h y + 4 a^2 c f h y + 2 a^2 b g h y - |
| 57 | * 3 a^3 h^2 y - 3 b c e^2 x y + 6 a d e^2 x y + 2 b^2 e f x y + |
| 58 | * a c e f x y - 2 a b f^2 x y - a b e g x y + 3 a^2 f g x y - |
| 59 | * 6 a^2 e h x y - 3 a e^2 x^2 y - b^3 e y^2 + 3 a b c e y^2 - |
| 60 | * 3 a^2 d e y^2 + a b^2 f y^2 - 2 a^2 c f y^2 - a^2 b g y^2 + |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 61 | * 3 a^3 h y^2 + 3 a^2 e x y^2 - a^3 y^3 |
| 62 | */ |
| 63 | |
| 64 | enum { |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 65 | xxx_coeff, // A |
| 66 | xxy_coeff, // B |
| 67 | xyy_coeff, // C |
| 68 | yyy_coeff, // D |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 69 | xx_coeff, |
| 70 | xy_coeff, |
| 71 | yy_coeff, |
| 72 | x_coeff, |
| 73 | y_coeff, |
| 74 | c_coeff, |
| 75 | coeff_count |
| 76 | }; |
| 77 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 78 | #define USE_SYVESTER 0 // if 0, use control-point base parametric form |
| 79 | #if USE_SYVESTER |
| 80 | |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 81 | // FIXME: factoring version unwritten |
| 82 | // static bool straight_forward = true; |
| 83 | |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 84 | /* from CubicParameterizationCode.cpp output: |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 85 | * double A = e * e * e; |
| 86 | * double B = -3 * a * e * e; |
| 87 | * double C = 3 * a * a * e; |
| 88 | * double D = -a * a * a; |
| 89 | */ |
| 90 | static void calc_ABCD(double a, double e, double p[coeff_count]) { |
| 91 | double ee = e * e; |
| 92 | p[xxx_coeff] = e * ee; |
| 93 | p[xxy_coeff] = -3 * a * ee; |
| 94 | double aa = a * a; |
| 95 | p[xyy_coeff] = 3 * aa * e; |
| 96 | p[yyy_coeff] = -aa * a; |
| 97 | } |
| 98 | |
| 99 | /* CubicParameterizationCode.cpp turns Mathematica output into C. |
| 100 | * Rather than edit the lines below, please edit the code there instead. |
| 101 | */ |
| 102 | // start of generated code |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 103 | static double calc_xx(double a, double b, double c, double d, |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 104 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 105 | return |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 106 | -3 * d * e * e * e |
| 107 | + c * e * e * f |
| 108 | - b * e * f * f |
| 109 | + a * f * f * f |
| 110 | + 2 * b * e * e * g |
| 111 | - 3 * a * e * f * g |
| 112 | + 3 * a * e * e * h; |
| 113 | } |
| 114 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 115 | static double calc_xy(double a, double b, double c, double d, |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 116 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 117 | return |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 118 | -3 * b * c * e * e |
| 119 | + 6 * a * d * e * e |
| 120 | + 2 * b * b * e * f |
| 121 | + a * c * e * f |
| 122 | - 2 * a * b * f * f |
| 123 | - a * b * e * g |
| 124 | + 3 * a * a * f * g |
| 125 | - 6 * a * a * e * h; |
| 126 | } |
| 127 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 128 | static double calc_yy(double a, double b, double c, double d, |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 129 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 130 | return |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 131 | -b * b * b * e |
| 132 | + 3 * a * b * c * e |
| 133 | - 3 * a * a * d * e |
| 134 | + a * b * b * f |
| 135 | - 2 * a * a * c * f |
| 136 | - a * a * b * g |
| 137 | + 3 * a * a * a * h; |
| 138 | } |
| 139 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 140 | static double calc_x(double a, double b, double c, double d, |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 141 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 142 | return |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 143 | 3 * d * d * e * e * e |
| 144 | - 2 * c * d * e * e * f |
| 145 | + 2 * b * d * e * f * f |
| 146 | - 2 * a * d * f * f * f |
| 147 | + c * c * e * e * g |
| 148 | - 4 * b * d * e * e * g |
| 149 | - b * c * e * f * g |
| 150 | + 6 * a * d * e * f * g |
| 151 | + a * c * f * f * g |
| 152 | + b * b * e * g * g |
| 153 | - 2 * a * c * e * g * g |
| 154 | - a * b * f * g * g |
| 155 | + a * a * g * g * g |
| 156 | + 3 * b * c * e * e * h |
| 157 | - 6 * a * d * e * e * h |
| 158 | - 2 * b * b * e * f * h |
| 159 | - a * c * e * f * h |
| 160 | + 2 * a * b * f * f * h |
| 161 | + a * b * e * g * h |
| 162 | - 3 * a * a * f * g * h |
| 163 | + 3 * a * a * e * h * h; |
| 164 | } |
| 165 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 166 | static double calc_y(double a, double b, double c, double d, |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 167 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 168 | return |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 169 | -c * c * c * e * e |
| 170 | + 3 * b * c * d * e * e |
| 171 | - 3 * a * d * d * e * e |
| 172 | + b * c * c * e * f |
| 173 | - 2 * b * b * d * e * f |
| 174 | - a * c * d * e * f |
| 175 | - a * c * c * f * f |
| 176 | + 2 * a * b * d * f * f |
| 177 | - b * b * c * e * g |
| 178 | + 2 * a * c * c * e * g |
| 179 | + a * b * d * e * g |
| 180 | + a * b * c * f * g |
| 181 | - 3 * a * a * d * f * g |
| 182 | - a * a * c * g * g |
| 183 | + 2 * b * b * b * e * h |
| 184 | - 6 * a * b * c * e * h |
| 185 | + 6 * a * a * d * e * h |
| 186 | - 2 * a * b * b * f * h |
| 187 | + 4 * a * a * c * f * h |
| 188 | + 2 * a * a * b * g * h |
| 189 | - 3 * a * a * a * h * h; |
| 190 | } |
| 191 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 192 | static double calc_c(double a, double b, double c, double d, |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 193 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 194 | return |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 195 | -d * d * d * e * e * e |
| 196 | + c * d * d * e * e * f |
| 197 | - b * d * d * e * f * f |
| 198 | + a * d * d * f * f * f |
| 199 | - c * c * d * e * e * g |
| 200 | + 2 * b * d * d * e * e * g |
| 201 | + b * c * d * e * f * g |
| 202 | - 3 * a * d * d * e * f * g |
| 203 | - a * c * d * f * f * g |
| 204 | - b * b * d * e * g * g |
| 205 | + 2 * a * c * d * e * g * g |
| 206 | + a * b * d * f * g * g |
| 207 | - a * a * d * g * g * g |
| 208 | + c * c * c * e * e * h |
| 209 | - 3 * b * c * d * e * e * h |
| 210 | + 3 * a * d * d * e * e * h |
| 211 | - b * c * c * e * f * h |
| 212 | + 2 * b * b * d * e * f * h |
| 213 | + a * c * d * e * f * h |
| 214 | + a * c * c * f * f * h |
| 215 | - 2 * a * b * d * f * f * h |
| 216 | + b * b * c * e * g * h |
| 217 | - 2 * a * c * c * e * g * h |
| 218 | - a * b * d * e * g * h |
| 219 | - a * b * c * f * g * h |
| 220 | + 3 * a * a * d * f * g * h |
| 221 | + a * a * c * g * g * h |
| 222 | - b * b * b * e * h * h |
| 223 | + 3 * a * b * c * e * h * h |
| 224 | - 3 * a * a * d * e * h * h |
| 225 | + a * b * b * f * h * h |
| 226 | - 2 * a * a * c * f * h * h |
| 227 | - a * a * b * g * h * h |
| 228 | + a * a * a * h * h * h; |
| 229 | } |
| 230 | // end of generated code |
| 231 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 232 | #else |
| 233 | |
| 234 | /* more Mathematica generated code. This takes a different tack, starting with |
| 235 | the control-point based parametric formulas. The C code is unoptimized -- |
| 236 | in this form, this is a proof of concept (since the other code didn't work) |
| 237 | */ |
| 238 | static double calc_c(double a, double b, double c, double d, |
| 239 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 240 | return |
| 241 | d*d*d*e*e*e - 3*d*d*(3*c*e*e*f + 3*b*e*(-3*f*f + 2*e*g) + a*(9*f*f*f - 9*e*f*g + e*e*h)) - |
| 242 | h*(27*c*c*c*e*e - 27*c*c*(3*b*e*f - 3*a*f*f + 2*a*e*g) + |
| 243 | h*(-27*b*b*b*e + 27*a*b*b*f - 9*a*a*b*g + a*a*a*h) + |
| 244 | 9*c*(9*b*b*e*g + a*b*(-9*f*g + 3*e*h) + a*a*(3*g*g - 2*f*h))) + |
| 245 | 3*d*(9*c*c*e*e*g + 9*b*b*e*(3*g*g - 2*f*h) + 3*a*b*(-9*f*g*g + 6*f*f*h + e*g*h) + |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 246 | a*a*(9*g*g*g - 9*f*g*h + e*h*h) + 3*c*(3*b*e*(-3*f*g + e*h) + a*(9*f*f*g - 6*e*g*g - e*f*h))) |
| 247 | ; |
| 248 | } |
| 249 | |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 250 | // - Power(e - 3*f + 3*g - h,3)*Power(x,3) |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 251 | static double calc_xxx(double e3f3gh) { |
| 252 | return -e3f3gh * e3f3gh * e3f3gh; |
| 253 | } |
| 254 | |
| 255 | static double calc_y(double a, double b, double c, double d, |
| 256 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 257 | return |
| 258 | + 3*(6*b*d*d*e*e - d*d*d*e*e + 18*b*b*d*e*f - 18*b*d*d*e*f - |
| 259 | 9*b*d*d*f*f - 54*b*b*d*e*g + 12*b*d*d*e*g - 27*b*b*d*g*g - 18*b*b*b*e*h + 18*b*b*d*e*h + |
| 260 | 18*b*b*d*f*h + a*a*a*h*h - 9*b*b*b*h*h + 9*c*c*c*e*(e + 2*h) + |
| 261 | a*a*(-3*b*h*(2*g + h) + d*(-27*g*g + 9*g*h - h*(2*e + h) + 9*f*(g + h))) + |
| 262 | a*(9*b*b*h*(2*f + h) - 3*b*d*(6*f*f - 6*f*(3*g - 2*h) + g*(-9*g + h) + e*(g + h)) + |
| 263 | d*d*(e*e + 9*f*(3*f - g) + e*(-9*f - 9*g + 2*h))) - |
| 264 | 9*c*c*(d*e*(e + 2*g) + 3*b*(f*h + e*(f + h)) + a*(-3*f*f - 6*f*h + 2*(g*h + e*(g + h)))) + |
| 265 | 3*c*(d*d*e*(e + 2*f) + a*a*(3*g*g + 6*g*h - 2*h*(2*f + h)) + 9*b*b*(g*h + e*(g + h)) + |
| 266 | a*d*(-9*f*f - 18*f*g + 6*g*g + f*h + e*(f + 12*g + h)) + |
| 267 | b*(d*(-3*e*e + 9*f*g + e*(9*f + 9*g - 6*h)) + 3*a*(h*(2*e - 3*g + h) - 3*f*(g + h))))) // *y |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 268 | ; |
| 269 | } |
| 270 | |
| 271 | static double calc_yy(double a, double b, double c, double d, |
| 272 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 273 | return |
| 274 | - 3*(18*c*c*c*e - 18*c*c*d*e + 6*c*d*d*e - d*d*d*e + 3*c*d*d*f - 9*c*c*d*g + a*a*a*h + 9*c*c*c*h - |
| 275 | 9*b*b*b*(e + 2*h) - a*a*(d*(e - 9*f + 18*g - 7*h) + 3*c*(2*f - 6*g + h)) + |
| 276 | a*(-9*c*c*(2*e - 6*f + 2*g - h) + d*d*(-7*e + 18*f - 9*g + h) + 3*c*d*(7*e - 17*f + 3*g + h)) + |
| 277 | 9*b*b*(3*c*(e + g + h) + a*(f + 2*h) - d*(e - 2*(f - 3*g + h))) - |
| 278 | 3*b*(-(d*d*(e - 6*f + 2*g)) - 3*c*d*(e + 3*f + 3*g - h) + 9*c*c*(e + f + h) + a*a*(g + 2*h) + |
| 279 | a*(c*(-3*e + 9*f + 9*g + 3*h) + d*(e + 3*f - 17*g + 7*h)))) // *Power(y,2) |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 280 | ; |
| 281 | } |
| 282 | |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 283 | // + Power(a - 3*b + 3*c - d,3)*Power(y,3) |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 284 | static double calc_yyy(double a3b3cd) { |
| 285 | return a3b3cd * a3b3cd * a3b3cd; |
| 286 | } |
| 287 | |
| 288 | static double calc_xx(double a, double b, double c, double d, |
| 289 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 290 | return |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 291 | // + Power(x,2)* |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 292 | (-3*(-9*b*e*f*f + 9*a*f*f*f + 6*b*e*e*g - 9*a*e*f*g + 27*b*e*f*g - 27*a*f*f*g + 18*a*e*g*g - 54*b*e*g*g + |
| 293 | 27*a*f*g*g + 27*b*f*g*g - 18*a*g*g*g + a*e*e*h - 9*b*e*e*h + 3*a*e*f*h + 9*b*e*f*h + 9*a*f*f*h - |
| 294 | 18*b*f*f*h - 21*a*e*g*h + 51*b*e*g*h - 9*a*f*g*h - 27*b*f*g*h + 18*a*g*g*h + 7*a*e*h*h - 18*b*e*h*h - 3*a*f*h*h + |
| 295 | 18*b*f*h*h - 6*a*g*h*h - 3*b*g*h*h + a*h*h*h + |
| 296 | 3*c*(-9*f*f*(g - 2*h) + 3*g*g*h - f*h*(9*g + 2*h) + e*e*(f - 6*g + 6*h) + |
| 297 | e*(9*f*g + 6*g*g - 17*f*h - 3*g*h + 3*h*h)) - |
| 298 | d*(e*e*e + e*e*(-6*f - 3*g + 7*h) - 9*(2*f - g)*(f*f + g*g - f*(g + h)) + |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 299 | e*(18*f*f + 9*g*g + 3*g*h + h*h - 3*f*(3*g + 7*h)))) ) |
| 300 | ; |
| 301 | } |
| 302 | |
| 303 | // + Power(x,2)*(3*(a - 3*b + 3*c - d)*Power(e - 3*f + 3*g - h,2)*y) |
| 304 | static double calc_xxy(double a3b3cd, double e3f3gh) { |
| 305 | return 3 * a3b3cd * e3f3gh * e3f3gh; |
| 306 | } |
| 307 | |
| 308 | static double calc_x(double a, double b, double c, double d, |
| 309 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 310 | return |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 311 | // + x* |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 312 | (-3*(27*b*b*e*g*g - 27*a*b*f*g*g + 9*a*a*g*g*g - 18*b*b*e*f*h + 18*a*b*f*f*h + 3*a*b*e*g*h - |
| 313 | 27*b*b*e*g*h - 9*a*a*f*g*h + 27*a*b*f*g*h - 9*a*a*g*g*h + a*a*e*h*h - 9*a*b*e*h*h + |
| 314 | 27*b*b*e*h*h + 6*a*a*f*h*h - 18*a*b*f*h*h - 9*b*b*f*h*h + 3*a*a*g*h*h + |
| 315 | 6*a*b*g*h*h - a*a*h*h*h + 9*c*c*(e*e*(g - 3*h) - 3*f*f*h + e*(3*f + 2*g)*h) + |
| 316 | d*d*(e*e*e - 9*f*f*f + 9*e*f*(f + g) - e*e*(3*f + 6*g + h)) + |
| 317 | d*(-3*c*(-9*f*f*g + e*e*(2*f - 6*g - 3*h) + e*(9*f*g + 6*g*g + f*h)) + |
| 318 | a*(-18*f*f*f - 18*e*g*g + 18*g*g*g - 2*e*e*h + 3*e*g*h + 2*e*h*h + 9*f*f*(3*g + 2*h) + |
| 319 | 3*f*(6*e*g - 9*g*g - e*h - 6*g*h)) - 3*b*(9*f*g*g + e*e*(4*g - 3*h) - 6*f*f*h - |
| 320 | e*(6*f*f + g*(18*g + h) - 3*f*(3*g + 4*h)))) + |
| 321 | 3*c*(3*b*(e*e*h + 3*f*g*h - e*(3*f*g - 6*f*h + 6*g*h + h*h)) + |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 322 | a*(9*f*f*(g - 2*h) + f*h*(-e + 9*g + 4*h) - 3*(2*g*g*h + e*(2*g*g - 4*g*h + h*h))))) ) |
| 323 | ; |
| 324 | } |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 325 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 326 | static double calc_xy(double a, double b, double c, double d, |
| 327 | double e, double f, double g, double h) { |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 328 | return |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 329 | // + x*3* |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 330 | (-2*a*d*e*e - 7*d*d*e*e + 15*a*d*e*f + 21*d*d*e*f - 9*a*d*f*f - 18*d*d*f*f - 15*a*d*e*g - |
| 331 | 3*d*d*e*g - 9*a*a*f*g + 9*d*d*f*g + 18*a*a*g*g + 9*a*d*g*g + 2*a*a*e*h - 2*d*d*e*h + |
| 332 | 3*a*a*f*h + 15*a*d*f*h - 21*a*a*g*h - 15*a*d*g*h + 7*a*a*h*h + 2*a*d*h*h - |
| 333 | 9*c*c*(2*e*e + 3*f*f + 3*f*h - 2*g*h + e*(-3*f - 4*g + h)) + |
| 334 | 9*b*b*(3*g*g - 3*g*h + 2*h*(-2*f + h) + e*(-2*f + 3*g + h)) + |
| 335 | 3*b*(3*c*(e*e + 3*e*(f - 3*g) + (9*f - 3*g - h)*h) + a*(6*f*f + e*g - 9*f*g - 9*g*g - 5*e*h + 9*f*h + 14*g*h - 7*h*h) + |
| 336 | d*(-e*e + 12*f*f - 27*f*g + e*(-9*f + 20*g - 5*h) + g*(9*g + h))) + |
| 337 | 3*c*(a*(-(e*f) - 9*f*f + 27*f*g - 12*g*g + 5*e*h - 20*f*h + 9*g*h + h*h) + |
| 338 | d*(7*e*e + 9*f*f + 9*f*g - 6*g*g - f*h + e*(-14*f - 9*g + 5*h)))) // *y |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 339 | ; |
| 340 | } |
| 341 | |
| 342 | // - x*3*Power(a - 3*b + 3*c - d,2)*(e - 3*f + 3*g - h)*Power(y,2) |
| 343 | static double calc_xyy(double a3b3cd, double e3f3gh) { |
| 344 | return -3 * a3b3cd * a3b3cd * e3f3gh; |
| 345 | } |
| 346 | |
| 347 | #endif |
| 348 | |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 349 | static double (*calc_proc[])(double a, double b, double c, double d, |
| 350 | double e, double f, double g, double h) = { |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 351 | calc_xx, calc_xy, calc_yy, calc_x, calc_y, calc_c |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 352 | }; |
| 353 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 354 | #if USE_SYVESTER |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 355 | /* Control points to parametric coefficients |
| 356 | s = 1 - t |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 357 | Attt + 3Btts + 3Ctss + Dsss == |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 358 | Attt + 3B(1 - t)tt + 3C(1 - t)(t - tt) + D(1 - t)(1 - 2t + tt) == |
| 359 | Attt + 3B(tt - ttt) + 3C(t - tt - tt + ttt) + D(1-2t+tt-t+2tt-ttt) == |
| 360 | Attt + 3Btt - 3Bttt + 3Ct - 6Ctt + 3Cttt + D - 3Dt + 3Dtt - Dttt == |
| 361 | D + (3C - 3D)t + (3B - 6C + 3D)tt + (A - 3B + 3C - D)ttt |
| 362 | a = A - 3*B + 3*C - D |
| 363 | b = 3*B - 6*C + 3*D |
| 364 | c = 3*C - 3*D |
| 365 | d = D |
| 366 | */ |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 367 | |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 368 | /* http://www.algorithmist.net/bezier3.html |
| 369 | p = 3 * A |
| 370 | q = 3 * B |
| 371 | r = 3 * C |
| 372 | a = A |
| 373 | b = q - p |
| 374 | c = p - 2 * q + r |
| 375 | d = D - A + q - r |
| 376 | |
| 377 | B(t) = a + t * (b + t * (c + t * d)) |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 378 | |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 379 | so |
rmistry@google.com | d6176b0 | 2012-08-23 18:14:13 +0000 | [diff] [blame] | 380 | |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 381 | B(t) = a + t*b + t*t*(c + t*d) |
| 382 | = a + t*b + t*t*c + t*t*t*d |
| 383 | */ |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 384 | static void set_abcd(const double* cubic, double& a, double& b, double& c, |
| 385 | double& d) { |
| 386 | a = cubic[0]; // a = A |
| 387 | b = 3 * cubic[2]; // b = 3*B (compute rest of b lazily) |
| 388 | c = 3 * cubic[4]; // c = 3*C (compute rest of c lazily) |
| 389 | d = cubic[6]; // d = D |
| 390 | a += -b + c - d; // a = A - 3*B + 3*C - D |
| 391 | } |
| 392 | |
| 393 | static void calc_bc(const double d, double& b, double& c) { |
| 394 | b -= 3 * c; // b = 3*B - 3*C |
| 395 | c -= 3 * d; // c = 3*C - 3*D |
| 396 | b -= c; // b = 3*B - 6*C + 3*D |
| 397 | } |
| 398 | |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 399 | static void alt_set_abcd(const double* cubic, double& a, double& b, double& c, |
| 400 | double& d) { |
| 401 | a = cubic[0]; |
| 402 | double p = 3 * a; |
| 403 | double q = 3 * cubic[2]; |
| 404 | double r = 3 * cubic[4]; |
| 405 | b = q - p; |
| 406 | c = p - 2 * q + r; |
| 407 | d = cubic[6] - a + q - r; |
| 408 | } |
| 409 | |
| 410 | const bool try_alt = true; |
| 411 | |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 412 | #else |
| 413 | |
| 414 | static void calc_ABCD(double a, double b, double c, double d, |
| 415 | double e, double f, double g, double h, |
| 416 | double p[coeff_count]) { |
| 417 | double a3b3cd = a - 3 * (b - c) - d; |
| 418 | double e3f3gh = e - 3 * (f - g) - h; |
| 419 | p[xxx_coeff] = calc_xxx(e3f3gh); |
| 420 | p[xxy_coeff] = calc_xxy(a3b3cd, e3f3gh); |
| 421 | p[xyy_coeff] = calc_xyy(a3b3cd, e3f3gh); |
| 422 | p[yyy_coeff] = calc_yyy(a3b3cd); |
| 423 | } |
| 424 | #endif |
| 425 | |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 426 | bool implicit_matches(const Cubic& one, const Cubic& two) { |
| 427 | double p1[coeff_count]; // a'xxx , b'xxy , c'xyy , d'xx , e'xy , f'yy, etc. |
| 428 | double p2[coeff_count]; |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 429 | #if USE_SYVESTER |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 430 | double a1, b1, c1, d1; |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 431 | if (try_alt) |
| 432 | alt_set_abcd(&one[0].x, a1, b1, c1, d1); |
| 433 | else |
| 434 | set_abcd(&one[0].x, a1, b1, c1, d1); |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 435 | double e1, f1, g1, h1; |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 436 | if (try_alt) |
| 437 | alt_set_abcd(&one[0].y, e1, f1, g1, h1); |
| 438 | else |
| 439 | set_abcd(&one[0].y, e1, f1, g1, h1); |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 440 | calc_ABCD(a1, e1, p1); |
| 441 | double a2, b2, c2, d2; |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 442 | if (try_alt) |
| 443 | alt_set_abcd(&two[0].x, a2, b2, c2, d2); |
| 444 | else |
| 445 | set_abcd(&two[0].x, a2, b2, c2, d2); |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 446 | double e2, f2, g2, h2; |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 447 | if (try_alt) |
| 448 | alt_set_abcd(&two[0].y, e2, f2, g2, h2); |
| 449 | else |
| 450 | set_abcd(&two[0].y, e2, f2, g2, h2); |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 451 | calc_ABCD(a2, e2, p2); |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 452 | #else |
| 453 | double a1 = one[0].x; |
| 454 | double b1 = one[1].x; |
| 455 | double c1 = one[2].x; |
| 456 | double d1 = one[3].x; |
| 457 | double e1 = one[0].y; |
| 458 | double f1 = one[1].y; |
| 459 | double g1 = one[2].y; |
| 460 | double h1 = one[3].y; |
| 461 | calc_ABCD(a1, b1, c1, d1, e1, f1, g1, h1, p1); |
| 462 | double a2 = two[0].x; |
| 463 | double b2 = two[1].x; |
| 464 | double c2 = two[2].x; |
| 465 | double d2 = two[3].x; |
| 466 | double e2 = two[0].y; |
| 467 | double f2 = two[1].y; |
| 468 | double g2 = two[2].y; |
| 469 | double h2 = two[3].y; |
| 470 | calc_ABCD(a2, b2, c2, d2, e2, f2, g2, h2, p2); |
| 471 | #endif |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 472 | int first = 0; |
| 473 | for (int index = 0; index < coeff_count; ++index) { |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 474 | #if USE_SYVESTER |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 475 | if (!try_alt && index == xx_coeff) { |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 476 | calc_bc(d1, b1, c1); |
| 477 | calc_bc(h1, f1, g1); |
| 478 | calc_bc(d2, b2, c2); |
| 479 | calc_bc(h2, f2, g2); |
| 480 | } |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 481 | #endif |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 482 | if (index >= xx_coeff) { |
| 483 | int procIndex = index - xx_coeff; |
| 484 | p1[index] = (*calc_proc[procIndex])(a1, b1, c1, d1, e1, f1, g1, h1); |
| 485 | p2[index] = (*calc_proc[procIndex])(a2, b2, c2, d2, e2, f2, g2, h2); |
| 486 | } |
| 487 | if (approximately_zero(p1[index]) || approximately_zero(p2[index])) { |
| 488 | first += first == index; |
| 489 | continue; |
| 490 | } |
| 491 | if (first == index) { |
| 492 | continue; |
| 493 | } |
caryclark@google.com | 6d0032a | 2013-01-04 19:41:13 +0000 | [diff] [blame] | 494 | if (!AlmostEqualUlps(p1[index] * p2[first], p1[first] * p2[index])) { |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 495 | return false; |
| 496 | } |
| 497 | } |
| 498 | return true; |
| 499 | } |
| 500 | |
| 501 | static double tangent(const double* cubic, double t) { |
| 502 | double a, b, c, d; |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 503 | #if USE_SYVESTER |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 504 | set_abcd(cubic, a, b, c, d); |
| 505 | calc_bc(d, b, c); |
caryclark@google.com | c682590 | 2012-02-03 22:07:47 +0000 | [diff] [blame] | 506 | #else |
| 507 | coefficients(cubic, a, b, c, d); |
| 508 | #endif |
caryclark@google.com | 639df89 | 2012-01-10 21:46:10 +0000 | [diff] [blame] | 509 | return 3 * a * t * t + 2 * b * t + c; |
| 510 | } |
| 511 | |
| 512 | void tangent(const Cubic& cubic, double t, _Point& result) { |
| 513 | result.x = tangent(&cubic[0].x, t); |
| 514 | result.y = tangent(&cubic[0].y, t); |
| 515 | } |
| 516 | |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 517 | // unit test to return and validate parametric coefficients |
| 518 | #include "CubicParameterization_TestUtility.cpp" |