distances.hpp 3.46 KB
Newer Older
thery's avatar
thery committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36
/*******************************************************************************
* CGoGN: Combinatorial and Geometric modeling with Generic N-dimensional Maps  *
* version 0.1                                                                  *
* Copyright (C) 2009-2012, IGG Team, LSIIT, University of Strasbourg           *
*                                                                              *
* This library is free software; 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 2.1 of the License, or (at your     *
* option) any later version.                                                   *
*                                                                              *
* This library 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 Lesser General Public License  *
* for more details.                                                            *
*                                                                              *
* You should have received a copy of the GNU Lesser General Public License     *
* along with this library; if not, write to the Free Software Foundation,      *
* Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA.           *
*                                                                              *
* Web site: http://cgogn.unistra.fr/                                           *
* Contact information: cgogn@unistra.fr                                        *
*                                                                              *
*******************************************************************************/

#include "Geometry/distances.h"

namespace CGoGN
{

namespace Algo
{

namespace Geometry
{

template <typename PFP>
Sylvain Thery's avatar
Sylvain Thery committed
37
typename PFP::REAL squaredDistancePoint2FacePlane(typename PFP::MAP& map, Face f, const VertexAttribute<typename PFP::VEC3, typename PFP::MAP>& position, const typename PFP::VEC3& P)
thery's avatar
thery committed
38
{
39 40 41 42 43 44
	Vertex v(f.dart);
	const typename PFP::VEC3& A = position[v];
	v.dart = map.phi1(v.dart);
	const typename PFP::VEC3& B = position[v];
	v.dart = map.phi1(v.dart);
	const typename PFP::VEC3& C = position[v];
thery's avatar
thery committed
45

46
	return Geom::squaredDistancePoint2TrianglePlane(P, A, B, C);
thery's avatar
thery committed
47 48 49
}

template <typename PFP>
Sylvain Thery's avatar
Sylvain Thery committed
50
typename PFP::REAL squaredDistancePoint2Face(typename PFP::MAP& map, Face f, const VertexAttribute<typename PFP::VEC3, typename PFP::MAP>& position, const typename PFP::VEC3& P)
thery's avatar
thery committed
51 52 53
{
	typedef typename PFP::REAL REAL;

54 55 56
	const typename PFP::VEC3& A = position[f.dart];

	Dart d = map.phi1(f.dart);
thery's avatar
thery committed
57
	Dart e = map.phi1(d);
58 59 60
	REAL dist2 = Geom::squaredDistancePoint2Triangle(P, A, position[d], position[e]);
	d = e;
	e = map.phi1(d);
thery's avatar
thery committed
61

62
	while (e != f.dart)
thery's avatar
thery committed
63
	{
64
		REAL d2 = Geom::squaredDistancePoint2Triangle(P, A, position[d], position[e]);
thery's avatar
thery committed
65 66
		if (d2 < dist2)
			dist2 = d2;
67 68
		d = e;
		e = map.phi1(d);
thery's avatar
thery committed
69
	}
70

thery's avatar
thery committed
71 72 73 74
	return dist2;
}

template <typename PFP>
Sylvain Thery's avatar
Sylvain Thery committed
75
typename PFP::REAL squaredDistancePoint2Edge(typename PFP::MAP& map, Edge e, const VertexAttribute<typename PFP::VEC3, typename PFP::MAP>& position, const typename PFP::VEC3& P)
thery's avatar
thery committed
76
{
77 78 79 80
	const typename PFP::VEC3& A = position[e.dart];
	typename PFP::VEC3 AB = position[map.phi1(e.dart)] - A;
	typename PFP::REAL AB2 = AB * AB;
	return Geom::squaredDistanceSeg2Point(A, AB, AB2, P) ;
thery's avatar
thery committed
81 82 83 84 85 86 87
}

} // namespace Geometry

} // namespace Algo

} // namespace CGoGN