Guest User

Catmull-Rom in C++

a guest
Jun 27th, 2015
393
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 2.58 KB | None | 0 0
  1. #ifndef CATMULLROM_H
  2. #define CATMULLROM_H
  3.  
  4. #include <vector>
  5.  
  6. template <typename T>
  7. T catmullrom(float t, T P0, T P1, T P2, T P3) {
  8.     float t2 = t * t, t3 = t2 * t;
  9.     return ((     - 0.5f * t + 1.0f * t2 - 0.5f * t3) * P0 +
  10.             (1.0f            - 2.5f * t2 + 1.5f * t3) * P1) +
  11.            ((       0.5f * t + 2.0f * t2 - 1.5f * t3) * P2 +
  12.             (                - 0.5f * t2 + 0.5f * t3) * P3);
  13. }
  14.  
  15. template <typename T>
  16. T catmullromdt(float t, T P0, T P1, T P2, T P3) {
  17.     float t2 = t * t;
  18.     return ((- 0.5f + 2.0f * t - 1.5f * t2) * P0 +
  19.             (       - 5.0f * t + 4.5f * t2) * P1) +
  20.            ((  0.5f + 4.0f * t - 4.5f * t2) * P2 +
  21.             (       - 1.0f * t + 1.5f * t2) * P3);
  22. }
  23.  
  24. template <typename T>
  25. T catmullrom(float t, const std::vector<T> &ps) {
  26.     if (t < 0) return ps[1];
  27.     int idx = (int)t;
  28.     t -= idx;
  29.     if (idx > (int)ps.size() - 4) return ps[ps.size() - 2];
  30.     return catmullrom(t, ps[idx], ps[idx+1], ps[idx+2], ps[idx+3]);
  31. }
  32.  
  33. template <typename T>
  34. T catmullrom2(float t, T P0, T P1, T P2, T P3) {
  35.     float t2 = t * t, t3 = t2 * t, t4 = t2 * t2, t5 = t2 * t3;
  36.     return ((       - 0.500f * t + 0.250f * t2 + 2.250f * t3 - 3.250f * t4 + 1.250f * t5) * P0 +
  37.             (1.000f              - 0.500f * t2 - 6.375f * t3 + 9.750f * t4 - 3.875f * t5) * P1) +
  38.            ((         0.500f * t + 0.250f * t2 + 6.000f * t3 - 9.750f * t4 + 4.000f * t5) * P2 +
  39.             (                                  - 1.875f * t3 + 3.250f * t4 - 1.375f * t5) * P3);
  40. }
  41.  
  42. template <typename T>
  43. T catmullrom2dt(float t, T P0, T P1, T P2, T P3) {
  44.     float t2 = t * t, t3 = t2 * t, t4 = t2 * t2;
  45.     return ((- 0.500f + 0.500f * t +  6.750f * t2 - 13.000f * t3 +  6.250f * t4) * P0 +
  46.             (         - 1.000f * t - 19.125f * t2 + 39.000f * t3 - 19.375f * t4) * P1) +
  47.            ((  0.500f + 0.500f * t + 18.000f * t2 - 39.000f * t3 + 20.000f * t4) * P2 +
  48.             (                      -  5.625f * t2 + 13.000f * t3 -  6.875f * t4) * P3);
  49. }
  50.  
  51. template <typename T>
  52. T catmullrom2dt2(float t, T P0, T P1, T P2, T P3) {
  53.     float t2 = t * t, t3 = t2 * t;
  54.     return ((+ 0.500f + 13.500f * t -  39.000f * t2 + 25.000f * t3) * P0 +
  55.             (- 1.000f - 38.250f * t + 117.000f * t2 - 77.500f * t3) * P1) +
  56.            ((+ 0.500f + 36.000f * t - 117.000f * t2 + 80.000f * t3) * P2 +
  57.             (         - 11.250f * t +  39.000f * t2 - 27.500f * t3) * P3);
  58. }
  59.  
  60. template <typename T>
  61. T catmullrom2(float t, const std::vector<T> &ps) {
  62.     if (t < 0) return ps[1];
  63.     int idx = (int)t;
  64.     t -= idx;
  65.     if (idx > (int)ps.size() - 4) return ps[ps.size() - 2];
  66.     return catmullrom2(t, ps[idx], ps[idx+1], ps[idx+2], ps[idx+3]);
  67. }
  68.  
  69. #endif
Advertisement
Add Comment
Please, Sign In to add comment