|
32
|
1 /**
|
|
|
2 * SPDX-FileCopyrightText: 2023-2024 Sebastien Jodogne, UCLouvain, Belgium
|
|
|
3 * SPDX-License-Identifier: GPL-3.0-or-later
|
|
|
4 */
|
|
|
5
|
|
|
6 /**
|
|
|
7 * STL plugin for Orthanc
|
|
|
8 * Copyright (C) 2023-2024 Sebastien Jodogne, UCLouvain, Belgium
|
|
|
9 *
|
|
|
10 * This program is free software: you can redistribute it and/or
|
|
|
11 * modify it under the terms of the GNU General Public License as
|
|
|
12 * published by the Free Software Foundation, either version 3 of the
|
|
|
13 * License, or (at your option) any later version.
|
|
|
14 *
|
|
|
15 * This program is distributed in the hope that it will be useful, but
|
|
|
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
18 * General Public License for more details.
|
|
|
19 *
|
|
|
20 * You should have received a copy of the GNU General Public License
|
|
|
21 * along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
22 **/
|
|
|
23
|
|
|
24
|
|
|
25 #include "Vector3D.h"
|
|
|
26
|
|
34
|
27 #include "STLToolbox.h"
|
|
32
|
28
|
|
|
29 #include <OrthancException.h>
|
|
|
30
|
|
|
31 #include <cmath>
|
|
|
32
|
|
|
33
|
|
|
34 Vector3D::Vector3D() :
|
|
|
35 x_(0),
|
|
|
36 y_(0),
|
|
|
37 z_(0)
|
|
|
38 {
|
|
|
39 }
|
|
|
40
|
|
|
41
|
|
|
42 Vector3D::Vector3D(double x,
|
|
|
43 double y,
|
|
|
44 double z) :
|
|
|
45 x_(x),
|
|
|
46 y_(y),
|
|
|
47 z_(z)
|
|
|
48 {
|
|
|
49 }
|
|
|
50
|
|
|
51
|
|
|
52 Vector3D::Vector3D(const Vector3D& from,
|
|
|
53 const Vector3D& to) :
|
|
|
54 x_(to.x_ - from.x_),
|
|
|
55 y_(to.y_ - from.y_),
|
|
|
56 z_(to.z_ - from.z_)
|
|
|
57 {
|
|
|
58 }
|
|
|
59
|
|
|
60
|
|
|
61 double Vector3D::ComputeSquaredNorm() const
|
|
|
62 {
|
|
|
63 return x_ * x_ + y_ * y_ + z_ * z_;
|
|
|
64 }
|
|
|
65
|
|
|
66
|
|
|
67 double Vector3D::ComputeNorm() const
|
|
|
68 {
|
|
|
69 return sqrt(ComputeSquaredNorm());
|
|
|
70 }
|
|
|
71
|
|
|
72
|
|
|
73 void Vector3D::Normalize()
|
|
|
74 {
|
|
|
75 double norm = ComputeNorm();
|
|
33
|
76 if (!STLToolbox::IsNear(norm, 0))
|
|
32
|
77 {
|
|
|
78 x_ /= norm;
|
|
|
79 y_ /= norm;
|
|
|
80 z_ /= norm;
|
|
|
81 }
|
|
|
82 }
|
|
|
83
|
|
|
84
|
|
|
85 Vector3D Vector3D::CrossProduct(const Vector3D& u,
|
|
|
86 const Vector3D& v)
|
|
|
87 {
|
|
|
88 return Vector3D(u.GetY() * v.GetZ() - u.GetZ() * v.GetY(),
|
|
|
89 u.GetZ() * v.GetX() - u.GetX() * v.GetZ(),
|
|
|
90 u.GetX() * v.GetY() - u.GetY() * v.GetX());
|
|
|
91 }
|
|
|
92
|
|
|
93
|
|
|
94 double Vector3D::DotProduct(const Vector3D& a,
|
|
|
95 const Vector3D& b)
|
|
|
96 {
|
|
|
97 return a.GetX() * b.GetX() + a.GetY() * b.GetY() + a.GetZ() * b.GetZ();
|
|
|
98 }
|
|
|
99
|
|
|
100
|
|
|
101 bool Vector3D::AreParallel(const Vector3D& a,
|
|
|
102 const Vector3D& b)
|
|
|
103 {
|
|
33
|
104 if (STLToolbox::IsNear(a.ComputeSquaredNorm(), 1) &&
|
|
|
105 STLToolbox::IsNear(b.ComputeSquaredNorm(), 1))
|
|
32
|
106 {
|
|
33
|
107 return STLToolbox::IsNear(std::abs(Vector3D::DotProduct(a, b)), 1);
|
|
32
|
108 }
|
|
|
109 else
|
|
|
110 {
|
|
|
111 throw Orthanc::OrthancException(Orthanc::ErrorCode_ParameterOutOfRange,
|
|
|
112 "Only applicable to normalized vectors");
|
|
|
113 }
|
|
|
114 }
|
