Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #ifndef CATMULLROM_H
- #define CATMULLROM_H
- #include <vector>
- template <typename T>
- T catmullrom(float t, T P0, T P1, T P2, T P3) {
- float t2 = t * t, t3 = t2 * t;
- return (( - 0.5f * t + 1.0f * t2 - 0.5f * t3) * P0 +
- (1.0f - 2.5f * t2 + 1.5f * t3) * P1) +
- (( 0.5f * t + 2.0f * t2 - 1.5f * t3) * P2 +
- ( - 0.5f * t2 + 0.5f * t3) * P3);
- }
- template <typename T>
- T catmullromdt(float t, T P0, T P1, T P2, T P3) {
- float t2 = t * t;
- return ((- 0.5f + 2.0f * t - 1.5f * t2) * P0 +
- ( - 5.0f * t + 4.5f * t2) * P1) +
- (( 0.5f + 4.0f * t - 4.5f * t2) * P2 +
- ( - 1.0f * t + 1.5f * t2) * P3);
- }
- template <typename T>
- T catmullrom(float t, const std::vector<T> &ps) {
- if (t < 0) return ps[1];
- int idx = (int)t;
- t -= idx;
- if (idx > (int)ps.size() - 4) return ps[ps.size() - 2];
- return catmullrom(t, ps[idx], ps[idx+1], ps[idx+2], ps[idx+3]);
- }
- template <typename T>
- T catmullrom2(float t, T P0, T P1, T P2, T P3) {
- float t2 = t * t, t3 = t2 * t, t4 = t2 * t2, t5 = t2 * t3;
- return (( - 0.500f * t + 0.250f * t2 + 2.250f * t3 - 3.250f * t4 + 1.250f * t5) * P0 +
- (1.000f - 0.500f * t2 - 6.375f * t3 + 9.750f * t4 - 3.875f * t5) * P1) +
- (( 0.500f * t + 0.250f * t2 + 6.000f * t3 - 9.750f * t4 + 4.000f * t5) * P2 +
- ( - 1.875f * t3 + 3.250f * t4 - 1.375f * t5) * P3);
- }
- template <typename T>
- T catmullrom2dt(float t, T P0, T P1, T P2, T P3) {
- float t2 = t * t, t3 = t2 * t, t4 = t2 * t2;
- return ((- 0.500f + 0.500f * t + 6.750f * t2 - 13.000f * t3 + 6.250f * t4) * P0 +
- ( - 1.000f * t - 19.125f * t2 + 39.000f * t3 - 19.375f * t4) * P1) +
- (( 0.500f + 0.500f * t + 18.000f * t2 - 39.000f * t3 + 20.000f * t4) * P2 +
- ( - 5.625f * t2 + 13.000f * t3 - 6.875f * t4) * P3);
- }
- template <typename T>
- T catmullrom2dt2(float t, T P0, T P1, T P2, T P3) {
- float t2 = t * t, t3 = t2 * t;
- return ((+ 0.500f + 13.500f * t - 39.000f * t2 + 25.000f * t3) * P0 +
- (- 1.000f - 38.250f * t + 117.000f * t2 - 77.500f * t3) * P1) +
- ((+ 0.500f + 36.000f * t - 117.000f * t2 + 80.000f * t3) * P2 +
- ( - 11.250f * t + 39.000f * t2 - 27.500f * t3) * P3);
- }
- template <typename T>
- T catmullrom2(float t, const std::vector<T> &ps) {
- if (t < 0) return ps[1];
- int idx = (int)t;
- t -= idx;
- if (idx > (int)ps.size() - 4) return ps[ps.size() - 2];
- return catmullrom2(t, ps[idx], ps[idx+1], ps[idx+2], ps[idx+3]);
- }
- #endif
Advertisement
Add Comment
Please, Sign In to add comment