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

Go to the documentation of this file.

 #ifndef OPENTISSUE_CORE_GEOMETRY_GEOMETRY_TETRAHEDRON_Z_SLICER_H
#define OPENTISSUE_CORE_GEOMETRY_GEOMETRY_TETRAHEDRON_Z_SLICER_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>

namespace OpenTissue
{
  namespace geometry
  {
    template<typename vector3_type_>
    class ZTetrahedronSlicer
    {
    public:

      typedef vector3_type_                      vector3_type;
      typedef typename vector3_type::value_type  real_type;

    protected:

      vector3_type  m_p[4];  

    public:

      ZTetrahedronSlicer(
        vector3_type const & p0
        , vector3_type const & p1
        , vector3_type const & p2
        , vector3_type const & p3
        )
      {
        m_p[0] = p0;
        m_p[1] = p1;
        m_p[2] = p2;
        m_p[3] = p3;

        //--- Primitive bubble sort - ensures that tetrahedron vertices
        //--- are sorted according to z value.
        while(swap(0,1)||swap(1,2)||swap(2,3));
      };

    protected:

      bool swap(int i,int j)
      {
        if(m_p[j](2)< m_p[i](2))
        {
          vector3_type tmp = m_p[j];
          m_p[j] = m_p[i];
          m_p[i] = tmp;
          return true;
        }
        return false;
      };

      void intersect(real_type const &  z, int i, int j, vector3_type & p) const
      {
        p = m_p[i];
        vector3_type dir = m_p[j] - m_p[i];
        real_type s = (z-m_p[i](2))/(m_p[j](2)-m_p[i](2));
        p += s * dir;
      };

    public:

      unsigned int intersect(real_type const & z, vector3_type slice[4]) const
      {
        if( z < m_p[0](2) || z > m_p[3](2) )
          return 0;
        if( z<m_p[1](2) )
        {
          intersect(z,0,3, slice[0]);
          intersect(z,0,1, slice[1]);
          intersect(z,0,2, slice[2]);
          return 3;
        }
        else if( z<m_p[2](2) )
        {
          intersect(z,0,3, slice[0]);
          intersect(z,1,3, slice[1]);
          intersect(z,1,2, slice[2]);
          intersect(z,0,2, slice[3]);
          return 4;
        }
        else
        {
          intersect(z,0,3, slice[0]);
          intersect(z,1,3, slice[1]);
          intersect(z,2,3, slice[2]);
          return 3;
        }
      }
      //     unsigned int intersect(real_type const & z, vector3_type slice[4]) const
      //     {
      //       unsigned int cnt=0;
      //       if(z > m_p[0](2))
      //       {
      //         if(z < m_p[3](2))
      //         {
      //           intersect(z,0,3,slice[cnt++]);
      //           if(z<m_p[1](2))
      //             intersect(z,0,1,slice[cnt++]);
      //           else
      //           {
      //             intersect(z,1,3,slice[cnt++]);
      //
      //             if(z<m_p[2](2))
      //               intersect(z,1,2,slice[cnt++]);
      //           }
      //           if(z<m_p[2](2))
      //             intersect(z,0,2, slice[cnt++]);
      //           else
      //             intersect(z,2,3,slice[cnt++]);
      //           return cnt;
      //         }
      //         else return 0;
      //       }
      //       else
      //         return 0;
      //     }

    };

  } // namespace geometry
} // namespace OpenTissue

//OPENTISSUE_CORE_GEOMETRY_GEOMETRY_TETRAHEDRON_Z_SLICER_H
#endif