/home/hauberg/Dokumenter/Capture/humim-tracker-0.1/src/OpenTissue/OpenTissue/core/math/optimization/optimization_perturbation.h

Go to the documentation of this file.

#ifndef OPENTISSUE_CORE_MATH_OPTIMIZATION_PERTURBATION_H
#define OPENTISSUE_CORE_MATH_OPTIMIZATION_PERTURBATION_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/big/big_types.h>

namespace OpenTissue
{
  namespace math
  {
    namespace optimization
    {

        template<typename T>
        inline void perturbation(
          boost::numeric::ublas::vector<T> & y
          , T const & lambda
          , ublas::compressed_matrix<T> const & A
          , ublas::vector<T> const & b
          , ublas::compressed_matrix<T>  & A_prime
          , ublas::vector<T>  & b_prime
          )
        {
          size_t const m = A.size1();
          size_t const n = A.size2();

          assert(m>0           || !"perturbation(): A was empty");
          assert(n>0           || !"perturbation(): A was empty");
          assert(m==n          || !"perturbation(): A was not square");
          assert(b.size() == m || !"perturbation(): Incompatible dimension between A and b");
          assert(y.size() == m || !"perturbation(): Incompatible dimension between b and y");

          A_prime.resize(m,n,false);
          b_prime.resize(n);
          A_prime.assign( A );
          b_prime.assign( b );

          for(size_t i=0;i<m;++i)
          {
            A_prime(i,i) += lambda;
            b_prime(i) -= lambda*y(i);
          }
        }

    } // namespace optimization
  } // namespace math
} // namespace OpenTissue

// OPENTISSUE_CORE_MATH_OPTIMIZATION_PERTURBATION_H
#endif