diff --git a/src/twistSpline.h b/src/twistSpline.h index 2d7840c..5f90d05 100644 --- a/src/twistSpline.h +++ b/src/twistSpline.h @@ -32,7 +32,6 @@ SOFTWARE. #include #include "twistSplineUtils.h" - /** * A helper function for quickly finding a single index and segment percentage for an input tValue * @@ -118,12 +117,6 @@ void multiLinearIndexes(const std::vector ¶ms, const std::vector getRemap() const { return remap; } Float getTotalLength() const { return totalLength; } - - /// Copy constructor TwistSpline(TwistSpline const &old){ this->verts = old.verts; @@ -884,7 +865,6 @@ class TwistSpline { solveTwist(); } - /** * Solve the locks of a parameter of the spline * Build a tridiagonal matrix that represents each vertex param as a relation to its neighbor params @@ -973,7 +953,6 @@ class TwistSpline { solveTridiagonalMatrix(mat, res); } - /** * Solve a tridiagonal matrix in linear time * If you set up parameter values in a specific way, they can be thought of as a matrix @@ -1062,6 +1041,26 @@ class TwistSpline { std::vector oriMap; solveTwistParamMatrix(orientVals, segLens, orientLocks, oriMap); + // Add an euler filter to the ori map. + Float tau = 6.283185307179586477; + Float pi = 3.141592653589793238; + for (size_t i = 1; i < oriMap.size(); ++i){ + Float diff = oriMap[i] - oriMap[i - 1]; + Float sign = 1.0; + if (diff < 0.0){ + diff *= -1.0; + sign = -1.0; + } + + int count = 0; + for (; count < 10; ++count){ + if (diff < pi){ + break; + } + diff -= tau; + } + oriMap[i] -= count * sign * tau; + } std::vector twistMap; solveTwistParamMatrix(userTwists, segLens, twistLocks, twistMap);