X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Fanimation.cpp;h=8135cb5995a406e5f9b722f5ca242b3c60eecb96;hb=cbe341d00829fd0eab8f3d4bde840ccae61be7e9;hp=1aa8242aca1eca403d10e3cb33a6f9d9fd8d1bc6;hpb=269a74980e2db1ee5004b643f23c2607a77ead58;p=libs%2Fgl.git diff --git a/source/animation.cpp b/source/animation.cpp index 1aa8242a..8135cb59 100644 --- a/source/animation.cpp +++ b/source/animation.cpp @@ -59,18 +59,17 @@ Animation::AxisInterpolation::AxisInterpolation(const double *axis1, const doubl { // Compute a normalized vector halfway between the two endpoints double half[3]; - double len = 0; + double a1_len = 0; + double h_len = 0; for(unsigned i=0; i<3; ++i) { half[i] = (axis1[i]+axis2[i])/2; - len += half[i]*half[i]; + a1_len += axis1[i]*axis1[i]; + h_len += half[i]*half[i]; } - len = sqrt(len); - for(unsigned i=0; i<3; ++i) - half[i] /= len; // Compute correction factors for smooth interpolation - double cos_half = axis1[0]*half[0]+axis1[1]*half[1]+axis1[2]*half[2]; + double cos_half = (axis1[0]*half[0]+axis1[1]*half[1]+axis1[2]*half[2])/sqrt(a1_len*h_len); double angle = acos(cos_half); slope = (angle ? angle/tan(angle) : 1); scale = cos_half;