Torque3D/Engine/source/afx/util/afxCurveEval.cpp
2017-07-26 19:38:34 +01:00

123 lines
4.2 KiB
C++

//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~~//
// Arcane-FX for MIT Licensed Open Source version of Torque 3D from GarageGames
// Copyright (C) 2015 Faust Logic, Inc.
//
// Permission is hereby granted, free of charge, to any person obtaining a copy
// of this software and associated documentation files (the "Software"), to
// deal in the Software without restriction, including without limitation the
// rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
// sell copies of the Software, and to permit persons to whom the Software is
// furnished to do so, subject to the following conditions:
//
// The above copyright notice and this permission notice shall be included in
// all copies or substantial portions of the Software.
//
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
// IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
// FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
// AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
// LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
// FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
// IN THE SOFTWARE.
//
//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~~//
#include "afx/arcaneFX.h"
#include "afx/util/afxCurveEval.h"
Point2F afxHermiteEval::evaluateCurve( Point2F &v0, Point2F &v1,
Point2F &t0, Point2F &t1, F32 t )
{
F32 t_3 = t*t*t;
F32 t_2 = t*t;
F32 h1 = ( 2.0f * t_3 ) - ( 3.0f * t_2 ) + 1;
F32 h2 = (-2.0f * t_3 ) + ( 3.0f * t_2 );
F32 h3 = t_3 - ( 2.0f * t_2 ) + t;
F32 h4 = t_3 - t_2;
Point2F v(
(h1*v0.x)+(h2*v1.x)+(h3*t0.x)+(h4*t1.x),
(h1*v0.y)+(h2*v1.y)+(h3*t0.y)+(h4*t1.y) );
return v;
}
Point2F afxHermiteEval::evaluateCurve( Point2F &v0, Point2F &v1, F32 t )
{
Point2F tangent( 1, 0 );
return( evaluateCurve( v0, v1, tangent, tangent, t ) );
}
Point2F afxHermiteEval::evaluateCurveTangent( Point2F &v0, Point2F &v1,
Point2F &t0, Point2F &t1, F32 t )
{
F32 t_2 = t*t;
F32 h1_der = ( 6.0f * t_2 ) - ( 6.0f * t );
F32 h2_der = (-6.0f * t_2 ) + ( 6.0f * t );
F32 h3_der = ( 3.0f * t_2 ) - ( 4.0f * t ) + 1;
F32 h4_der = ( 3.0f * t_2 ) - ( 2.0f * t );
Point2F tangent(
(h1_der*v0.x)+(h2_der*v1.x)+(h3_der*t0.x)+(h4_der*t1.x),
(h1_der*v0.y)+(h2_der*v1.y)+(h3_der*t0.y)+(h4_der*t1.y) );
return tangent;
}
Point2F afxHermiteEval::evaluateCurveTangent( Point2F &v0, Point2F &v1, F32 t )
{
Point2F tangent( 1, 0 );
return( evaluateCurveTangent( v0, v1, tangent, tangent, t ) );
}
Point3F afxHermiteEval::evaluateCurve( Point3F &v0, Point3F &v1,
Point3F &t0, Point3F &t1, F32 t )
{
F32 t_3 = t*t*t;
F32 t_2 = t*t;
F32 h1 = ( 2.0f * t_3 ) - ( 3.0f * t_2 ) + 1;
F32 h2 = (-2.0f * t_3 ) + ( 3.0f * t_2 );
F32 h3 = t_3 - ( 2.0f * t_2 ) + t;
F32 h4 = t_3 - t_2;
Point3F v(
(h1*v0.x)+(h2*v1.x)+(h3*t0.x)+(h4*t1.x),
(h1*v0.y)+(h2*v1.y)+(h3*t0.y)+(h4*t1.y),
(h1*v0.z)+(h2*v1.z)+(h3*t0.z)+(h4*t1.z) );
return v;
}
Point3F afxHermiteEval::evaluateCurve( Point3F &v0, Point3F &v1, F32 t )
{
Point3F tangent( 1, 0, 0 );
return( evaluateCurve( v0, v1, tangent, tangent, t ) );
}
Point3F afxHermiteEval::evaluateCurveTangent( Point3F &v0, Point3F &v1,
Point3F &t0, Point3F &t1, F32 t )
{
F32 t_2 = t*t;
F32 h1_der = ( 6.0f * t_2 ) - ( 6.0f * t );
F32 h2_der = (-6.0f * t_2 ) + ( 6.0f * t );
F32 h3_der = ( 3.0f * t_2 ) - ( 4.0f * t ) + 1;
F32 h4_der = ( 3.0f * t_2 ) - ( 2.0f * t );
Point3F tangent(
(h1_der*v0.x)+(h2_der*v1.x)+(h3_der*t0.x)+(h4_der*t1.x),
(h1_der*v0.y)+(h2_der*v1.y)+(h3_der*t0.y)+(h4_der*t1.y),
(h1_der*v0.z)+(h2_der*v1.z)+(h3_der*t0.z)+(h4_der*t1.z) );
return tangent;
}
Point3F afxHermiteEval::evaluateCurveTangent( Point3F &v0, Point3F &v1, F32 t )
{
Point3F tangent( 1, 0, 0 );
return( evaluateCurveTangent( v0, v1, tangent, tangent, t ) );
}
//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~//~~~~~~~~~~~~~~~~~~~~~//