| 1 | /* |
| 2 | * Copyright 2018 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 | */ |
| 7 | |
| 8 | #ifndef SkCubicSolver_DEFINED |
| 9 | #define SkCubicSolver_DEFINED |
| 10 | |
| 11 | #include "include/core/SkTypes.h" |
| 12 | #include "include/private/SkFloatingPoint.h" |
| 13 | |
| 14 | //#define CUBICMAP_TRACK_MAX_ERROR |
| 15 | |
| 16 | namespace SK_OPTS_NS { |
| 17 | |
| 18 | static float eval_poly(float t, float b) { |
| 19 | return b; |
| 20 | } |
| 21 | |
| 22 | template <typename... Rest> |
| 23 | static float eval_poly(float t, float m, float b, Rest... rest) { |
| 24 | return eval_poly(t, sk_fmaf(m,t,b), rest...); |
| 25 | } |
| 26 | |
| 27 | inline float cubic_solver(float A, float B, float C, float D) { |
| 28 | #ifdef CUBICMAP_TRACK_MAX_ERROR |
| 29 | static int max_iters = 0; |
| 30 | #endif |
| 31 | |
| 32 | #ifdef SK_DEBUG |
| 33 | auto valid = [](float t) { |
| 34 | return t >= 0 && t <= 1; |
| 35 | }; |
| 36 | #endif |
| 37 | |
| 38 | auto guess_nice_cubic_root = [](float a, float b, float c, float d) { |
| 39 | return -d; |
| 40 | }; |
| 41 | float t = guess_nice_cubic_root(A, B, C, D); |
| 42 | |
| 43 | int iters = 0; |
| 44 | const int MAX_ITERS = 8; |
| 45 | for (; iters < MAX_ITERS; ++iters) { |
| 46 | SkASSERT(valid(t)); |
| 47 | float f = eval_poly(t, A,B,C,D); // f = At^3 + Bt^2 + Ct + D |
| 48 | if (sk_float_abs(f) <= 0.00005f) { |
| 49 | break; |
| 50 | } |
| 51 | float fp = eval_poly(t, 3*A, 2*B, C); // f' = 3At^2 + 2Bt + C |
| 52 | float fpp = eval_poly(t, 3*A+3*A, 2*B); // f'' = 6At + 2B |
| 53 | |
| 54 | float numer = 2 * fp * f; |
| 55 | float denom = sk_fmaf(2*fp, fp, -(f*fpp)); |
| 56 | |
| 57 | t -= numer / denom; |
| 58 | } |
| 59 | |
| 60 | #ifdef CUBICMAP_TRACK_MAX_ERROR |
| 61 | if (max_iters < iters) { |
| 62 | max_iters = iters; |
| 63 | SkDebugf("max_iters %d\n" , max_iters); |
| 64 | } |
| 65 | #endif |
| 66 | SkASSERT(valid(t)); |
| 67 | return t; |
| 68 | } |
| 69 | |
| 70 | } // namespace SK_OPTS_NS |
| 71 | #endif |
| 72 | |