include
fcl
narrowphase
detail
primitive_shape_algorithm
triangle_distance.h
Go to the documentation of this file.
1
/*
2
* Software License Agreement (BSD License)
3
*
4
* Copyright (c) 2011-2014, Willow Garage, Inc.
5
* Copyright (c) 2014-2016, Open Source Robotics Foundation
6
* All rights reserved.
7
*
8
* Redistribution and use in source and binary forms, with or without
9
* modification, are permitted provided that the following conditions
10
* are met:
11
*
12
* * Redistributions of source code must retain the above copyright
13
* notice, this list of conditions and the following disclaimer.
14
* * Redistributions in binary form must reproduce the above
15
* copyright notice, this list of conditions and the following
16
* disclaimer in the documentation and/or other materials provided
17
* with the distribution.
18
* * Neither the name of Open Source Robotics Foundation nor the names of its
19
* contributors may be used to endorse or promote products derived
20
* from this software without specific prior written permission.
21
*
22
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
27
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
28
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
29
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
30
* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
32
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33
* POSSIBILITY OF SUCH DAMAGE.
34
*/
35
38
#ifndef FCL_NARROWPHASE_DETAIL_TRIANGLEDISTANCE_H
39
#define FCL_NARROWPHASE_DETAIL_TRIANGLEDISTANCE_H
40
41
#include "
fcl/common/types.h
"
42
43
namespace
fcl
44
{
45
46
namespace
detail
47
{
48
50
template
<
typename
S>
51
class
FCL_EXPORT
TriangleDistance
52
{
53
public
:
54
60
static
void
segPoints(
const
Vector3<S>
& P,
const
Vector3<S>
& A,
const
Vector3<S>
& Q,
const
Vector3<S>
& B,
61
Vector3<S>
& VEC,
Vector3<S>
& X,
Vector3<S>
& Y);
62
68
static
S triDistance(
const
Vector3<S>
T1[3],
const
Vector3<S>
T2[3],
Vector3<S>
& P,
Vector3<S>
& Q);
69
70
static
S triDistance(
const
Vector3<S>
& S1,
const
Vector3<S>
& S2,
const
Vector3<S>
& S3,
71
const
Vector3<S>
& T1,
const
Vector3<S>
& T2,
const
Vector3<S>
& T3,
72
Vector3<S>
& P,
Vector3<S>
& Q);
73
80
static
S triDistance(
const
Vector3<S>
T1[3],
const
Vector3<S>
T2[3],
81
const
Matrix3<S>
& R,
const
Vector3<S>
& Tl,
82
Vector3<S>
& P,
Vector3<S>
& Q);
83
84
static
S triDistance(
const
Vector3<S>
T1[3],
const
Vector3<S>
T2[3],
85
const
Transform3<S>
& tf,
86
Vector3<S>
& P,
Vector3<S>
& Q);
87
88
static
S triDistance(
const
Vector3<S>
& S1,
const
Vector3<S>
& S2,
const
Vector3<S>
& S3,
89
const
Vector3<S>
& T1,
const
Vector3<S>
& T2,
const
Vector3<S>
& T3,
90
const
Matrix3<S>
& R,
const
Vector3<S>
& Tl,
91
Vector3<S>
& P,
Vector3<S>
& Q);
92
93
static
S triDistance(
94
const
Vector3<S>
& S1,
95
const
Vector3<S>
& S2,
96
const
Vector3<S>
& S3,
97
const
Vector3<S>
& T1,
98
const
Vector3<S>
& T2,
99
const
Vector3<S>
& T3,
100
const
Transform3<S>
& tf,
101
Vector3<S>
& P,
102
Vector3<S>
& Q);
103
104
};
105
106
using
TriangleDistancef
=
TriangleDistance<float>
;
107
using
TriangleDistanced
=
TriangleDistance<double>
;
108
109
}
// namespace detail
110
}
// namespace fcl
111
112
#include "
fcl/narrowphase/detail/primitive_shape_algorithm/triangle_distance-inl.h
"
113
114
#endif
fcl::Transform3
Eigen::Transform< S, 3, Eigen::Isometry > Transform3
Definition:
types.h:91
types.h
triangle_distance-inl.h
fcl::Vector3
Eigen::Matrix< S, 3, 1 > Vector3
Definition:
types.h:70
fcl::Matrix3
Eigen::Matrix< S, 3, 3 > Matrix3
Definition:
types.h:85
fcl::detail::TriangleDistance
Triangle distance functions.
Definition:
triangle_distance.h:51
fcl
Main namespace.
Definition:
broadphase_bruteforce-inl.h:45
fcl
Author(s):
autogenerated on Tue Dec 5 2023 03:40:49