cgal/Intersections_2/include/CGAL/Ray_2_Ray_2_intersection.h

282 lines
8.7 KiB
C++

// Copyright (c) 2000
// Utrecht University (The Netherlands),
// ETH Zurich (Switzerland),
// INRIA Sophia-Antipolis (France),
// Max-Planck-Institute Saarbruecken (Germany),
// and Tel-Aviv University (Israel). All rights reserved.
//
// This file is part of CGAL (www.cgal.org); you can redistribute it and/or
// modify it under the terms of the GNU Lesser General Public License as
// published by the Free Software Foundation; either version 3 of the License,
// or (at your option) any later version.
//
// Licensees holding a valid commercial license may use this file in
// accordance with the commercial license agreement provided with the software.
//
// This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
// WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
//
// $URL$
// $Id$
//
//
// Author(s) : Geert-Jan Giezeman
#ifndef CGAL_RAY_2_RAY_2_INTERSECTION_H
#define CGAL_RAY_2_RAY_2_INTERSECTION_H
#include <CGAL/Ray_2.h>
#include <CGAL/Segment_2.h>
#include <CGAL/Point_2.h>
#include <CGAL/kernel_assertions.h>
#include <CGAL/number_utils.h>
#include <CGAL/Line_2.h>
#include <CGAL/Line_2_Line_2_intersection.h>
#include <CGAL/Object.h>
namespace CGAL {
namespace internal {
template <class K>
class Ray_2_Ray_2_pair {
public:
enum Intersection_results {NO_INTERSECTION, POINT, SEGMENT, RAY};
Ray_2_Ray_2_pair(typename K::Ray_2 const *ray1,
typename K::Ray_2 const *ray2)
: _ray1(ray1), _ray2(ray2), _known(false) {}
Intersection_results intersection_type() const;
typename K::Point_2 intersection_point() const;
typename K::Segment_2 intersection_segment() const;
typename K::Ray_2 intersection_ray() const;
protected:
typename K::Ray_2 const* _ray1;
typename K::Ray_2 const * _ray2;
mutable bool _known;
mutable Intersection_results _result;
mutable typename K::Point_2 _intersection_point, _other_point;
};
template <class K>
inline bool do_intersect(
const typename K::Ray_2 &p1,
const typename K::Ray_2 &p2,
const K&)
{
typedef Ray_2_Ray_2_pair<K> pair_t;
pair_t pair(&p1, &p2);
return pair.intersection_type() != pair_t::NO_INTERSECTION;
}
template <class K>
typename Ray_2_Ray_2_pair<K>::Intersection_results
Ray_2_Ray_2_pair<K>::intersection_type() const
{
if (_known)
return _result;
// The non const this pointer is used to cast away const.
_known = true;
// if (!do_overlap(_ray1->bbox(), _ray2->bbox()))
// return NO_INTERSECTION;
const typename K::Line_2 &l1 = _ray1->supporting_line();
const typename K::Line_2 &l2 = _ray2->supporting_line();
Line_2_Line_2_pair<K> linepair(&l1, &l2);
switch ( linepair.intersection_type()) {
case Line_2_Line_2_pair<K>::NO_INTERSECTION:
_result = NO_INTERSECTION;
return _result;
case Line_2_Line_2_pair<K>::POINT:
_intersection_point = linepair.intersection_point();
_result = (_ray1->collinear_has_on(_intersection_point)
&& _ray2->collinear_has_on(_intersection_point) )
? POINT : NO_INTERSECTION;
return _result;
case Line_2_Line_2_pair<K>::LINE:
{
//typedef typename K::RT RT;
const typename K::Vector_2 &dir1 = _ray1->direction().to_vector();
const typename K::Vector_2 &dir2 = _ray2->direction().to_vector();
if (CGAL_NTS abs(dir1.x()) > CGAL_NTS abs(dir1.y())) {
typedef typename K::FT FT;
if (dir1.x() > FT(0)) {
if (dir2.x() > FT(0)) {
_intersection_point =
(_ray1->source().x() < _ray2->source().x())
? _ray2->source() : _ray1->source();
_result = RAY;
return _result;
} else {
if (_ray1->source().x() > _ray2->source().x()) {
_result = NO_INTERSECTION;
return _result;
}
if (_ray1->source().x() == _ray2->source().x()) {
_intersection_point = _ray1->source();
_result = POINT;
return _result;
}
_result = SEGMENT;
return _result;
}
} else {
if (dir2.x() < FT(0)) {
_intersection_point =
(_ray1->source().x() > _ray2->source().x())
? _ray2->source() : _ray1->source();
_result = RAY;
return _result;
} else {
if (_ray1->source().x() < _ray2->source().x()) {
_result = NO_INTERSECTION;
return _result;
}
if (_ray1->source().x() == _ray2->source().x()) {
_intersection_point = _ray1->source();
_result = POINT;
return _result;
}
_result = SEGMENT;
return _result;
}
}
} else {
typedef typename K::FT FT;
if (dir1.y() > FT(0)) {
if (dir2.y() > FT(0)) {
_intersection_point =
(_ray1->source().y() < _ray2->source().y())
? _ray2->source() : _ray1->source();
_result = RAY;
return _result;
} else {
if (_ray1->source().y() > _ray2->source().y()) {
_result = NO_INTERSECTION;
return _result;
}
if (_ray1->source().y() == _ray2->source().y()) {
_intersection_point = _ray1->source();
_result = POINT;
return _result;
}
_result = SEGMENT;
return _result;
}
} else {
if (dir2.y() < FT(0)) {
_intersection_point =
(_ray1->source().y() > _ray2->source().y())
? _ray2->source() : _ray1->source();
_result = RAY;
return _result;
} else {
if (_ray1->source().y() < _ray2->source().y()) {
_result = NO_INTERSECTION;
return _result;
}
if (_ray1->source().y() == _ray2->source().y()) {
_intersection_point = _ray1->source();
_result = POINT;
return _result;
}
_result = SEGMENT;
return _result;
}
}
}
}
default:
CGAL_kernel_assertion(false); // should not be reached:
return _result;
}
}
template <class K>
typename K::Point_2
Ray_2_Ray_2_pair<K>::intersection_point() const
{
if (!_known)
intersection_type();
CGAL_kernel_assertion(_result == POINT);
return _intersection_point;
}
template <class K>
typename K::Segment_2
Ray_2_Ray_2_pair<K>::intersection_segment() const
{
typedef typename K::Segment_2 Segment_2;
if (!_known)
intersection_type();
CGAL_kernel_assertion(_result == SEGMENT);
return Segment_2(_ray1->source(), _ray2->source());
}
template <class K>
typename K::Ray_2
Ray_2_Ray_2_pair<K>::intersection_ray() const
{
typedef typename K::Ray_2 Ray_2;
if (!_known)
intersection_type();
CGAL_kernel_assertion(_result == RAY);
return Ray_2(_intersection_point, _ray1->direction());
}
template <class K>
Object
intersection(const typename K::Ray_2 &ray1,
const typename K::Ray_2 &ray2,
const K&)
{
typedef Ray_2_Ray_2_pair<K> is_t;
is_t ispair(&ray1, &ray2);
switch (ispair.intersection_type()) {
case is_t::NO_INTERSECTION:
default:
return Object();
case is_t::POINT:
return make_object(ispair.intersection_point());
case is_t::SEGMENT:
return make_object(ispair.intersection_segment());
case is_t::RAY:
return make_object(ispair.intersection_ray());
}
}
} // namespace internal
template <class K>
inline
bool
do_intersect(const Ray_2<K> &ray1,
const Ray_2<K> &ray2)
{
typedef typename K::Do_intersect_2 Do_intersect;
return Do_intersect()(ray1, ray2);
}
template <class K>
Object
intersection(const Ray_2<K> &ray1,
const Ray_2<K> &ray2)
{
typedef typename K::Intersect_2 Intersect;
return Intersect()(ray1, ray2);
}
} //namespace CGAL
#endif