caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 1 | #include "QuadraticUtilities.h" |
caryclark@google.com | d88e089 | 2012-03-27 13:23:51 +0000 | [diff] [blame] | 2 | #include <math.h> |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 3 | |
| 4 | int quadraticRoots(double A, double B, double C, double t[2]) { |
| 5 | B *= 2; |
| 6 | double square = B * B - 4 * A * C; |
| 7 | if (square < 0) { |
| 8 | return 0; |
| 9 | } |
| 10 | double squareRt = sqrt(square); |
| 11 | double Q = (B + (B < 0 ? -squareRt : squareRt)) / -2; |
caryclark@google.com | 78e1713 | 2012-04-17 11:40:34 +0000 | [diff] [blame^] | 12 | double ratio; |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 13 | int foundRoots = 0; |
| 14 | if ((Q <= A) ^ (Q < 0)) { |
caryclark@google.com | 78e1713 | 2012-04-17 11:40:34 +0000 | [diff] [blame^] | 15 | ratio = Q / A; |
| 16 | if (!isnan(ratio)) { |
| 17 | t[foundRoots++] = ratio; |
| 18 | } |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 19 | } |
| 20 | if ((C <= Q) ^ (C < 0)) { |
caryclark@google.com | 78e1713 | 2012-04-17 11:40:34 +0000 | [diff] [blame^] | 21 | ratio = C / Q; |
| 22 | if (!isnan(ratio)) { |
| 23 | t[foundRoots++] = ratio; |
| 24 | } |
caryclark@google.com | 27accef | 2012-01-25 18:57:23 +0000 | [diff] [blame] | 25 | } |
| 26 | return foundRoots; |
| 27 | } |
| 28 | |
| 29 | |