InterpolationAnimationT_impl.hh

/*===========================================================================*\
*                                                                            *
*                              OpenFlipper                                   *
 *           Copyright (c) 2001-2015, RWTH-Aachen University                 *
 *           Department of Computer Graphics and Multimedia                  *
 *                          All rights reserved.                             *
 *                            www.openflipper.org                            *
 *                                                                           *
 *---------------------------------------------------------------------------*
 * This file is part of OpenFlipper.                                         *
 *---------------------------------------------------------------------------*
 *                                                                           *
 * Redistribution and use in source and binary forms, with or without        *
 * modification, are permitted provided that the following conditions        *
 * are met:                                                                  *
 *                                                                           *
 * 1. Redistributions of source code must retain the above copyright notice, *
 *    this list of conditions and the following disclaimer.                  *
 *                                                                           *
 * 2. Redistributions in binary form must reproduce the above copyright      *
 *    notice, this list of conditions and the following disclaimer in the    *
 *    documentation and/or other materials provided with the distribution.   *
 *                                                                           *
 * 3. Neither the name of the copyright holder nor the names of its          *
 *    contributors may be used to endorse or promote products derived from   *
 *    this software without specific prior written permission.               *
 *                                                                           *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS       *
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED *
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A           *
 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER *
 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,  *
 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,       *
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR        *
 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF    *
 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING      *
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS        *
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.              *
*                                                                            *
\*===========================================================================*/



#define INTERPOLATIONANIMATIONT_C

#include "AnimationT.hh"

#include <vector>
#include <cassert>
#include <cmath>
//-----------------------------------------------------------------------------------------------------

template<class PointT>
InterpolationAnimationT<PointT>::InterpolationAnimationT(const InterpolationAnimationT<PointT> &_other) :
        AnimationT<PointT>(_other.name_),
        skeleton_(_other.skeleton_),
        matrixManipulator_(_other.matrixManipulator_),
        frames_(0)
{
        
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
InterpolationAnimationT<PointT>::InterpolationAnimationT(Skeleton* _skeleton, MatrixManipulator *_matrixManipulator) :
        skeleton_(_skeleton),
        matrixManipulator_(_matrixManipulator),
        frames_(0)
{

}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
InterpolationAnimationT<PointT>::~InterpolationAnimationT()
{
  clearPoseCache();
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
AnimationT<PointT>* InterpolationAnimationT<PointT>::copy() {
  return new InterpolationAnimationT<PointT>(*this);
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
PoseT<PointT>* InterpolationAnimationT<PointT>::pose(unsigned int _iFrame)
{
  return pose(_iFrame, skeleton_->referencePose());
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
PoseT<PointT>* InterpolationAnimationT<PointT>::pose(unsigned int _iFrame, Pose* _reference)
{
//          std::cerr << "Frame " << _iFrame << ": ";
  
        if (interpolatedPoses_.find(_iFrame) != interpolatedPoses_.end()) {
//           std::cerr << "(from cache)" << std::endl;
          return (interpolatedPoses_[_iFrame]);
        } else {
        
          if (_iFrame == 0) {
            interpolatedPoses_.insert( std::make_pair(0, new Pose(*_reference)) );
//             std::cerr << "Insert reference to posecache. &_reference: " << _reference << ", &cacheref: " << getPose(_iFrame, _reference) << std::endl;
            return pose(_iFrame, _reference);
          } else {
            //Find the correct interpolator
            Interpolator* interpolator = NULL;
            unsigned long min = 0;
            
            uint i;
            for (i=0; i<interpolators_.size(); ++i) {
              min = (i==0 ? 0.0 : calcAbsoluteMaxForInterpolator(i-1) + 1);
              const unsigned long max = calcAbsoluteMaxForInterpolator(i);
              if (_iFrame >= min && _iFrame <= max) {
                interpolator = interpolators_[i];
                break;
              }
            }
            
            if (interpolator == NULL) {
//               std::cerr << "No appropriate interpolator found for this frame!" << std::endl;
              return _reference;
            }
            
//             std::cerr << "Using interpolator " << i << " - ";
            
            //Create a new pose that is a copy of the reference and apply the interpolated transformations to it
            Pose *generatedPose = new Pose(*_reference);
            
            for (uint i=0; i<influencedJoints_.size(); ++i) {
              ACG::GLMatrixT<Scalar> transformation(generatedPose->globalMatrix(influencedJoints_[i]).raw());
              //The frames for each interpolator are stored from 0..max, i.e. in "interpolator local time space".
              // So, they have to be mapped to the global space here.
              TargetType precalcVal = precalculations_[interpolator][_iFrame - min];
              
              matrixManipulator_->doManipulation(transformation, precalcVal);
              generatedPose->setGlobalMatrix(influencedJoints_[i], transformation, false);
            }
            
//             std::cerr << std::endl;
            
            interpolatedPoses_.insert(std::pair<unsigned long, Pose*>(_iFrame, generatedPose));
            return (interpolatedPoses_.find(_iFrame)->second);
          }
          
          
      }
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
unsigned int InterpolationAnimationT<PointT>::frameCount()
{
  return frames_;
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
void InterpolationAnimationT<PointT>::insertJointAt(unsigned int _index)
{
  //NOOP
}

//-----------------------------------------------------------------------------------------------------


template<class PointT>
void InterpolationAnimationT<PointT>::removeJointAt(unsigned int _index)
{
  //NOOP
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
void InterpolationAnimationT<PointT>::updateFromGlobal(unsigned int _index)
{
  //NOOP
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
void InterpolationAnimationT<PointT>::addInterpolator(InterpolationT<double> *_interpolator) {
  if (_interpolator == NULL)
    return;
  
  interpolators_.push_back(_interpolator);
//   std::cerr << "Precalc for interpolator " << interpolators_.size()-1 << ":" << std::endl;
  
  std::vector < TargetType > valueVector;
  
  //Precalc values for this interpolator
  uint i=0;
  for (i=_interpolator->getMinInput()*FPS;i<=(_interpolator->getMaxInput()) * FPS;++i) {
    TargetType precalcValue;
    double input = ((double)i) / ((double)FPS);
    precalcValue = _interpolator->getValue(input);
    valueVector.push_back(precalcValue);
    
//      std::cerr << "Frame " << i << "(t=" << input << "): " << precalcValue[0] << std::endl;
  }
  
//   std::cerr << std::endl;
  
  precalculations_.insert( std::pair< Interpolator*, std::vector < TargetType > >(_interpolator, valueVector) );
  
  frames_ = std::max<long unsigned int>(frames_, i+1);
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
InterpolationT<typename PointT::value_type>*
InterpolationAnimationT<PointT>::interpolator(unsigned int _index)
{
  if ( _index < interpolators_.size() )
    return interpolators_[ _index ];
  else 
    return 0;
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
unsigned int InterpolationAnimationT<PointT>::interpolatorCount()
{
  return interpolators_.size();
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
unsigned int InterpolationAnimationT<PointT>::calcAbsoluteMaxForInterpolator(uint _index) {
  assert (_index < interpolators_.size());
  
  if (_index == 0) {
    return precalculations_[interpolators_[_index]].size() - 1;
  } else {
    return precalculations_[interpolators_[_index]].size() + calcAbsoluteMaxForInterpolator(_index - 1);
  }
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
bool InterpolationAnimationT<PointT>::getMinInput(Scalar& _result) {
  if (interpolators_.size() == 0)
    return false;
  else
    _result = interpolators_[0]->getMinInput();
  
  for (uint i=0;i<interpolators_.size();++i) {
    if (interpolators_[i]->getMinInput() < _result)
      _result = interpolators_[i]->getMinInput();
  }
  
  return true;
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
bool InterpolationAnimationT<PointT>::getMaxInput(Scalar& _result) {
  if (interpolators_.size() == 0)
    return false;
  else
    _result = interpolators_[0]->getMaxInput();
  
  for (uint i=0;i<interpolators_.size();++i) {
    if (interpolators_[i]->getMaxInput() > _result)
      _result = interpolators_[i]->getMaxInput();
  }
  
  return true;
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
bool InterpolationAnimationT<PointT>::isInfluenced(int _joint) {
  for (uint i=0; i<influencedJoints_.size(); ++i) 
    if ( influencedJoints_[i] == _joint )
      return true;
    
  return false;
}

//-----------------------------------------------------------------------------------------------------

template<class PointT>
std::vector<int>& InterpolationAnimationT<PointT>::influencedJoints() {
  return influencedJoints_;
}

//-----------------------------------------------------------------------------------------------------