Ball3D.ih

#pragma once


#include <cstdlib>


// IMPLEMENTATION of inline methods.

// ----------------------- Standard services ------------------------------
typedef pair<double,double> AngularCoordinates;
template <typename T>
inline
DGtal::Ball3D<T>::~Ball3D()
{
}

template <typename T>
inline
DGtal::Ball3D<T>::Ball3D(const double x0, const double y0, const double z0, const double radius):
  myRadius(radius), myCenter(x0,y0,z0)
{}


template <typename T>
inline
DGtal::Ball3D<T>::Ball3D(const RealPoint &aPoint, const double radius):
  myRadius(radius), myCenter(aPoint)
{}


// ------------- Implementation of 'StarShaped' services ------------------

template <typename T>
inline
AngularCoordinates
DGtal::Ball3D<T>::parameter( const RealPoint & pp ) const
{
  RealPoint l( pp );
  l -= myCenter;
  AngularCoordinates angle ;
  
  
  
  if((fabs(l[0])<0.0001)&&(fabs(l[1])<0.0001))
    {
      angle.first=0;
      if(l[2]>=0)
        angle.second=0;
      if(l[2]<0)
        angle.second=M_PI;
    }
  else
    {
      if(l[1]>0)
        angle.first=atan2(l[1],l[0]);
      else 
        angle.first=atan2(l[1],l[0])+M_PI*2.0;
      angle.second=acos(sqrt(l[2]*l[2])/sqrt(l[0]*l[0]+l[1]*l[1]+l[2]*l[2]));
    }
  return angle;
}

template <typename T>
inline
typename DGtal::Ball3D<T>::RealPoint
DGtal::Ball3D<T>::x( AngularCoordinates t ) const
{
  RealPoint c( myRadius*cos(t.first)*sin(t.second), myRadius*sin(t.first)*sin(t.second) , myRadius*cos(t.second));
  c += myCenter;
  return c;
}



template <typename T>
inline
typename DGtal::Ball3D<T>::RealPoint
DGtal::Ball3D<T>::gradient( const AngularCoordinates t) const
{
  RealPoint p= x(t);
  double xx=2*(p[0]-myCenter[0]);
  double yy =2*(p[1]-myCenter[1]);
  double zz=2*(p[2]-myCenter[2]);
  return RealPoint(xx,yy,zz);
}

template <typename T>
inline
typename DGtal::Ball3D<T>::RealPoint
DGtal::Ball3D<T>::rt( const AngularCoordinates t) const
{
  return RealPoint(-myRadius*sin(t.first)*sin(t.second),myRadius*cos(t.first)*sin(t.second),0);
}



template <typename T>
inline
typename DGtal::Ball3D<T>::RealPoint
DGtal::Ball3D<T>::rp( const AngularCoordinates t) const
{
  return RealPoint(myRadius*cos(t.first)*cos(t.second),myRadius*sin(t.first)*cos(t.second),-myRadius*sin(t.second));
}


template <typename T>
inline
typename DGtal::Ball3D<T>::RealPoint
DGtal::Ball3D<T>::rtt( const AngularCoordinates t) const
{
  return RealPoint(-myRadius*cos(t.first)*sin(t.second),-myRadius*sin(t.first)*sin(t.second),0);
}



template <typename T>
inline
typename DGtal::Ball3D<T>::RealPoint
DGtal::Ball3D<T>::rpp( const AngularCoordinates t) const
{
  return RealPoint(-myRadius*cos(t.first)*sin(t.second),-myRadius*sin(t.first)*sin(t.second),-myRadius*cos(t.second));
}
    
template <typename T>
inline
typename DGtal::Ball3D<T>::RealPoint
DGtal::Ball3D<T>::rtp( const AngularCoordinates t) const
{
  return RealPoint(-myRadius*sin(t.first)*cos(t.second),myRadius*cos(t.first)*cos(t.second),0);
}
    

    
    
// Interface - public :

template <typename T>
inline
void
DGtal::Ball3D<T>::selfDisplay ( std::ostream & out ) const
{
  out << "[Ball3D] center= "<<myCenter<<" radius="<<myRadius;
}

template <typename T>
inline
bool
DGtal::Ball3D<T>::isValid() const
{
  return true;
}





// Implementation of inline functions //

template <typename T>
inline
std::ostream&
DGtal::operator<< ( std::ostream & out,
                    const Ball3D<T> & object )
{
  object.selfDisplay( out );
  return out;
}

// //