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 | |