/home/hauberg/Dokumenter/Capture/humim-tracker-0.1/src/OpenTissue/OpenTissue/dynamics/mbd/math/mbd_math_update_f.h

Go to the documentation of this file.

#ifndef OPENTISSUE_DYNAMICS_MBD_UTIL_MATH_UPDATE_F_H
#define OPENTISSUE_DYNAMICS_MBD_UTIL_MATH_UPDATE_F_H
//
// OpenTissue Template Library
// - A generic toolbox for physics-based modeling and simulation.
// Copyright (C) 2008 Department of Computer Science, University of Copenhagen.
//
// OTTL is licensed under zlib: http://opensource.org/licenses/zlib-license.php
//
#include <OpenTissue/configuration.h>

#include <OpenTissue/core/math/math_is_number.h>

#include <cassert>

namespace OpenTissue
{
  namespace mbd
  {
    namespace math
    {

      template<typename matrix_type, typename size_type, typename real_type, typename vector_type>
      void update_f(
        matrix_type const & WJT
        , size_type   const & i
        , real_type   const & dx
        , vector_type       & f
        )
      {
        assert( WJT.size1() >0         || !"update_f(): WJT was empty?"      );
        assert( WJT.size2() >0         || !"update_f(): WJT was empty?"      );
        assert(i < WJT.size1()         || !"update_f(): incorrect i-value"   );
        assert(f.size() == WJT.size2() || !"update_f(): incorrect dimensions");
        assert(is_number(dx)           || !"update_f(): not a number encountered");

        size_type  begin = WJT.index1_data () [i];
        size_type  end   = WJT.index1_data () [i + 1];
        assert( (end-begin)==12 || !"update_f(): incorrect format of WJT");
        for (size_type j = begin; j < end; ++j)
        {
          assert(is_number(WJT.value_data()[j]) || !"update_f(): not a number encountered");
          f(WJT.index2_data()[j]) += WJT.value_data()[j] * dx;
          assert( is_number(  f(WJT.index2_data()[j]) ) || !"update_f(): not a number encountered");
        }
      }



    } // end  namespace math
  } // end  namespace mbd
} // end namespace OpenTissue
// OPENTISSUE_DYNAMICS_MBD_UTIL_MATH_UPDATE_F_H
#endif