line3.h

Go to the documentation of this file.

/****************************************************************************
* VCGLib                                                            o o     *
* Visual and Computer Graphics Library                            o     o   *
*                                                                _   O  _   *
* Copyright(C) 2004                                                \/)\/    *
* Visual Computing Lab                                            /\/|      *
* ISTI - Italian National Research Council                           |      *
*                                                                    \      *
* All rights reserved.                                                      *
*                                                                           *
* This program is free software; you can redistribute it and/or modify      *   
* it under the terms of the GNU General Public License as published by      *
* the Free Software Foundation; either version 2 of the License, or         *
* (at your option) any later version.                                       *
*                                                                           *
* This program is distributed in the hope that it will be useful,           *
* but WITHOUT ANY WARRANTY; without even the implied warranty of            *
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the             *
* GNU General Public License (http://www.gnu.org/licenses/gpl.txt)          *
* for more details.                                                         *
*                                                                           *
****************************************************************************/
/****************************************************************************
  History

$Log: not supported by cvs2svn $
Revision 1.8  2004/05/14 03:14:04  ponchio
Added Distance

Revision 1.7  2004/05/10 10:58:35  ganovelli
name of the constructor changed from LineType to Line3

Revision 1.6  2004/03/11 11:47:20  tarini
minor updates, corrections, added documentations, etc.

Revision 1.5  2004/03/10 15:27:48  tarini
added Normalized flag


Revision 1.1  2004/03/08 16:15:48  tarini
first version (tarini)

****************************************************************************/



#ifndef __VCGLIB_LINE3
#define __VCGLIB_LINE3

#include <vcg/space/point3.h>

namespace vcg {

template <class LineScalarType, bool NORM=false>
class Line3
{
public: 

        typedef LineScalarType ScalarType;

        typedef Point3<LineScalarType> PointType;

        typedef Line3<LineScalarType,NORM> LineType;

private:

        PointType _ori;

        PointType _dir;

public:



  inline const PointType &Origin() const { return _ori; } 
  inline PointType &Origin() { return _ori; } 
  inline const PointType &Direction() const { return _dir; } 
        inline void SetOrigin( const PointType & ori )
        {       _ori=ori; }
        inline void SetDirection( const PointType & dir)
        {       _dir=dir; if (NORM) _dir.Normalize();  }
        inline void Set( const PointType & ori, const PointType & dir )
        {       SetOrigin(ori); SetDirection(dir); }



        Line3() {};
        Line3(const PointType &ori, const PointType &dir) {SetOrigin(ori); SetDirection(dir);};

        inline bool operator == ( LineType const & p ) const
        {       return _ori==p._ori && _dir==p._dir; }
        inline bool operator != ( LineType const & p ) const
        {       return _ori!=p._ori || _dir!=p._dir; }
        inline ScalarType Projection( const  PointType &p ) const
        { if (NORM) return ScalarType((p-_ori).dot(_dir));
                else      return ScalarType((p-_ori).dot(_dir)/_dir.SquaredNorm());
        }
        static bool IsNormalized() {return NORM;};
        inline PointType P( const ScalarType t ) const
        { return _ori + _dir * t; }
        inline Line3<ScalarType,true> &Normalize()
        { if (!NORM) _dir.Normalize(); return *((Line3<ScalarType,true>*)this);}
        static Line3<ScalarType,true> &Normalize(LineType &p)
        { p.Normalize(); return *((Line3<ScalarType,true>*)(&p));}
        template <class Q, bool K>
        inline void Import( const Line3<Q,K> & b )
        { _ori.Import( b.Origin() );    _dir.Import( b.Direction() ); 
          if ((NORM) && (!K)) _dir.Normalize(); 
                //printf("(=)%c->%c ",(!NORM)?'N':'n', NORM?'N':'n');
        }
        template <class Q, bool K>
        static LineType Construct( const Line3<Q,K> & b )
        { LineType res; res.Import(b);  return res;
        }       
        PointType ClosestPoint(const PointType & p) const{
        return P(Projection(p));
        }
        inline void Flip(){
                _dir=-_dir;
        };


        inline Line3<ScalarType,false> operator + ( LineType const & p) const
        {return Line3<ScalarType,false> ( _ori+p.Origin(), _dir+p.Direction() );}
        inline Line3<ScalarType,false> operator - ( LineType const & p) const
        {return Line3<ScalarType,false> ( _ori-p.Origin(), _dir-p.Direction() );}
        inline Line3<ScalarType,false> operator * ( const ScalarType s ) const
        {return Line3<ScalarType,false> ( _ori*s, _dir*s );}
        inline Line3<ScalarType,false> operator / ( const ScalarType s ) const
        {ScalarType s0=((ScalarType)1.0)/s; return LineType( _ori*s0, _dir*s0 );}




        Line3 (const Line3<ScalarType,!NORM > &r) 
        { Import(r); };
        inline LineType & operator = ( Line3<ScalarType,!NORM> const &r) 
        { Import(r); return *this; };

}; // end class definition

typedef Line3<short>  Line3s;
typedef Line3<int>        Line3i;
typedef Line3<float>  Line3f;
typedef Line3<double> Line3d;

typedef Line3<short ,true> Line3sN;
typedef Line3<int   ,true> Line3iN;
typedef Line3<float ,true> Line3fN;
typedef Line3<double,true> Line3dN;

template <class ScalarType, bool NORM> 
Point3<ScalarType> ClosestPoint( Line3<ScalarType,NORM> l, const Point3<ScalarType> & p) 
{
        return l.P(l.Projection(p)); 
}

template <class ScalarType, bool NORM> 
ScalarType Distance(const Line3<ScalarType, NORM> &l, 
                    const Point3<ScalarType> &p) {
  Point3<ScalarType> o = l.ClosestPoint(p);
  return (o - p).Norm();
}

} // end namespace
#endif