92 lines
2.8 KiB
C
92 lines
2.8 KiB
C
|
// Copyright (c) 1999
|
||
|
|
// 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$
|
||
|
|
// SPDX-License-Identifier: LGPL-3.0+
|
||
|
|
//
|
||
|
|
//
|
||
|
|
// Author(s) : Stefan Schirra
|
||
|
|
|
||
|
|
|
||
|
|
#ifndef CGAL_BASIC_CONSTRUCTIONSH3_H
|
||
|
|
#define CGAL_BASIC_CONSTRUCTIONSH3_H
|
||
|
|
|
||
|
|
#include <CGAL/Cartesian/Point_3.h>
|
||
|
|
#include <CGAL/Cartesian/Plane_3.h>
|
||
|
|
|
||
|
|
|
||
|
|
namespace CGAL {
|
||
|
|
|
||
|
|
template <class R>
|
||
|
|
typename R::Point_3
|
||
|
|
_projection(const typename R::Point_3& p, const PlaneH3<R>& pl)
|
||
|
|
{
|
||
|
|
typedef typename R::RT RT;
|
||
|
|
if ( pl.has_on(p) ) return p;
|
||
|
|
|
||
|
|
RT A = pl.a();
|
||
|
|
RT B = pl.b();
|
||
|
|
RT C = pl.c();
|
||
|
|
RT D = pl.d();
|
||
|
|
RT phx = p.hx();
|
||
|
|
RT phy = p.hy();
|
||
|
|
RT phz = p.hz();
|
||
|
|
RT phw = p.hw();
|
||
|
|
|
||
|
|
RT num = A * phx + B * phy + C * phz + D * phw;
|
||
|
|
RT den = A * A + B * B + C * C;
|
||
|
|
|
||
|
|
return typename R::Point_3( num * A - den * phx,
|
||
|
|
num * B - den * phy,
|
||
|
|
num * C - den * phz,
|
||
|
|
-den );
|
||
|
|
}
|
||
|
|
|
||
|
|
template <class R>
|
||
|
|
typename R::Point_3
|
||
|
|
gp_linear_intersection(const PlaneH3<R> &f,
|
||
|
|
const PlaneH3<R> &g,
|
||
|
|
const PlaneH3<R> &h)
|
||
|
|
{
|
||
|
|
typedef typename R::RT RT;
|
||
|
|
return typename R::Point_3(
|
||
|
|
determinant<RT>(-f.d(), f.b(), f.c(),
|
||
|
|
-g.d(), g.b(), g.c(),
|
||
|
|
-h.d(), h.b(), h.c()),
|
||
|
|
determinant<RT>( f.a(),-f.d(), f.c(),
|
||
|
|
g.a(),-g.d(), g.c(),
|
||
|
|
h.a(),-h.d(), h.c()),
|
||
|
|
determinant<RT>( f.a(), f.b(),-f.d(),
|
||
|
|
g.a(), g.b(),-g.d(),
|
||
|
|
h.a(), h.b(),-h.d()),
|
||
|
|
determinant<RT>( f.a(), f.b(), f.c(),
|
||
|
|
g.a(), g.b(), g.c(),
|
||
|
|
h.a(), h.b(), h.c()));
|
||
|
|
}
|
||
|
|
|
||
|
|
template <class R>
|
||
|
|
CGAL_KERNEL_INLINE
|
||
|
|
typename R::FT
|
||
|
|
squared_distance( PointH3<R> const& p, PointH3<R> const& q)
|
||
|
|
{ return (p-q)*(p-q); }
|
||
|
|
|
||
|
|
} //namespace CGAL
|
||
|
|
|
||
|
|
#endif // CGAL_BASIC_CONSTRUCTIONSH3_H
|