/home/hauberg/Dokumenter/Capture/humim-tracker-0.1/src/OpenTissue/OpenTissue/core/geometry/geometry_angle_from_cot.h

Go to the documentation of this file.

#ifndef OPENTISSUE_CORE_GEOMETRY_GEOMETRY_ANGLE_FROM_COT_H
#define OPENTISSUE_CORE_GEOMETRY_GEOMETRY_ANGLE_FROM_COT_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 <cmath>   // Needed for std::sqrt and std::fabs
#include <cassert> // Needed for assert

namespace OpenTissue
{
  namespace geometry
  {

    template<typename vector_type>
    typename vector_type::value_type angle_from_cot(vector_type const & p,vector_type const & pi,vector_type const & pj)  
    {
      using std::sqrt;
      using std::fabs;
      using std::atan2;

      typedef typename vector_type::value_type   real_type;

      vector_type u = pi-p;
      vector_type v = pj-p;
      real_type dot = u*v;
      real_type denom = sqrt( (u*u)*(v*v) - dot*dot );

      return fabs(atan2(denom,dot));
    }

  } // namespace geometry
} // namespace OpenTissue

//OPENTISSUE_CORE_GEOMETRY_GEOMETRY_ANGLE_FROM_COT_H
#endif