IntersectionImpl.hpp

/* $ Id: $ */

namespace jafar {
  namespace geom {
    template<int dimension>
    bool intersection( const Line<dimension>& l1, const HyperPlane<dimension>& hyp, typename Atom<dimension>::HomogenousVecD& vec )
    {
      typedef typename Atom<dimension>::HomogenousVecD HomogenousVecD;
      HomogenousVecD normal = hyp.normal();
      HomogenousVecD origin = hyp.origin();
      HomogenousVecD fp = l1.origin();
      HomogenousVecD lp = l1.pointAt(1.0);
      double d = ublas::inner_prod(normal, lp - fp);
      if( d < 1e-6) return false;
      double u = ublas::inner_prod(normal, origin - fp) / d;
      vec = l1.pointAt(u);
      return true;
    }

  }
}