Mercurial > hg > orthanc-stone
annotate Framework/Toolbox/CoordinateSystem3D.cpp @ 152:2e023be0563c wasm
cont
| author | Sebastien Jodogne <s.jodogne@gmail.com> |
|---|---|
| date | Thu, 01 Feb 2018 18:42:34 +0100 |
| parents | c5044bbfc303 |
| children | 2309e8d86efe |
| rev | line source |
|---|---|
| 0 | 1 /** |
| 2 * Stone of Orthanc | |
| 3 * Copyright (C) 2012-2016 Sebastien Jodogne, Medical Physics | |
| 4 * Department, University Hospital of Liege, Belgium | |
|
135
e2fe9352f240
upgrade to year 2018
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
122
diff
changeset
|
5 * Copyright (C) 2017-2018 Osimis S.A., Belgium |
| 0 | 6 * |
| 7 * This program is free software: you can redistribute it and/or | |
| 47 | 8 * modify it under the terms of the GNU Affero General Public License |
| 9 * as published by the Free Software Foundation, either version 3 of | |
| 10 * the License, or (at your option) any later version. | |
| 0 | 11 * |
| 12 * This program is distributed in the hope that it will be useful, but | |
| 13 * WITHOUT ANY WARRANTY; without even the implied warranty of | |
| 47 | 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 * Affero General Public License for more details. | |
| 16 * | |
| 17 * You should have received a copy of the GNU Affero General Public License | |
| 0 | 18 * along with this program. If not, see <http://www.gnu.org/licenses/>. |
| 19 **/ | |
| 20 | |
| 21 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
22 #include "CoordinateSystem3D.h" |
| 0 | 23 |
| 24 #include "GeometryToolbox.h" | |
| 25 | |
|
113
2eca030792aa
using the Orthanc Framework
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
110
diff
changeset
|
26 #include <Core/Logging.h> |
|
2eca030792aa
using the Orthanc Framework
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
110
diff
changeset
|
27 #include <Core/Toolbox.h> |
|
2eca030792aa
using the Orthanc Framework
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
110
diff
changeset
|
28 #include <Core/OrthancException.h> |
| 0 | 29 |
| 30 namespace OrthancStone | |
| 31 { | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
32 void CoordinateSystem3D::CheckAndComputeNormal() |
| 0 | 33 { |
| 34 // DICOM expects normal vectors to define the axes: "The row and | |
| 35 // column direction cosine vectors shall be normal, i.e., the dot | |
| 36 // product of each direction cosine vector with itself shall be | |
| 37 // unity." | |
| 38 // http://dicom.nema.org/medical/dicom/current/output/chtml/part03/sect_C.7.6.2.html | |
| 39 if (!GeometryToolbox::IsNear(boost::numeric::ublas::norm_2(axisX_), 1.0) || | |
| 40 !GeometryToolbox::IsNear(boost::numeric::ublas::norm_2(axisY_), 1.0)) | |
| 41 { | |
| 42 throw Orthanc::OrthancException(Orthanc::ErrorCode_BadFileFormat); | |
| 43 } | |
| 44 | |
| 45 // The vectors within "Image Orientation Patient" must be | |
| 46 // orthogonal, according to the DICOM specification: "The row and | |
| 47 // column direction cosine vectors shall be orthogonal, i.e., | |
| 48 // their dot product shall be zero." | |
| 49 // http://dicom.nema.org/medical/dicom/current/output/chtml/part03/sect_C.7.6.2.html | |
| 50 if (!GeometryToolbox::IsCloseToZero(boost::numeric::ublas::inner_prod(axisX_, axisY_))) | |
| 51 { | |
| 52 throw Orthanc::OrthancException(Orthanc::ErrorCode_BadFileFormat); | |
| 53 } | |
| 54 | |
| 55 GeometryToolbox::CrossProduct(normal_, axisX_, axisY_); | |
| 56 | |
| 57 // Just a sanity check, it should be useless by construction | |
| 58 assert(GeometryToolbox::IsNear(boost::numeric::ublas::norm_2(normal_), 1.0)); | |
| 59 } | |
| 60 | |
| 61 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
62 void CoordinateSystem3D::SetupCanonical() |
| 0 | 63 { |
| 64 GeometryToolbox::AssignVector(origin_, 0, 0, 0); | |
| 65 GeometryToolbox::AssignVector(axisX_, 1, 0, 0); | |
| 66 GeometryToolbox::AssignVector(axisY_, 0, 1, 0); | |
| 67 CheckAndComputeNormal(); | |
| 68 } | |
| 69 | |
| 70 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
71 CoordinateSystem3D::CoordinateSystem3D(const Vector& origin, |
|
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
72 const Vector& axisX, |
|
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
73 const Vector& axisY) : |
| 0 | 74 origin_(origin), |
| 75 axisX_(axisX), | |
| 76 axisY_(axisY) | |
| 77 { | |
| 78 CheckAndComputeNormal(); | |
| 79 } | |
| 80 | |
| 81 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
82 void CoordinateSystem3D::Setup(const std::string& imagePositionPatient, |
|
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
83 const std::string& imageOrientationPatient) |
| 0 | 84 { |
| 85 std::string tmpPosition = Orthanc::Toolbox::StripSpaces(imagePositionPatient); | |
| 86 std::string tmpOrientation = Orthanc::Toolbox::StripSpaces(imageOrientationPatient); | |
| 87 | |
| 88 Vector orientation; | |
| 89 if (!GeometryToolbox::ParseVector(origin_, tmpPosition) || | |
| 90 !GeometryToolbox::ParseVector(orientation, tmpOrientation) || | |
| 91 origin_.size() != 3 || | |
| 92 orientation.size() != 6) | |
| 93 { | |
| 94 throw Orthanc::OrthancException(Orthanc::ErrorCode_BadFileFormat); | |
| 95 } | |
| 96 | |
| 97 axisX_.resize(3); | |
| 98 axisX_[0] = orientation[0]; | |
| 99 axisX_[1] = orientation[1]; | |
| 100 axisX_[2] = orientation[2]; | |
| 101 | |
| 102 axisY_.resize(3); | |
| 103 axisY_[0] = orientation[3]; | |
| 104 axisY_[1] = orientation[4]; | |
| 105 axisY_[2] = orientation[5]; | |
| 106 | |
| 107 CheckAndComputeNormal(); | |
| 108 } | |
| 109 | |
| 110 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
111 CoordinateSystem3D::CoordinateSystem3D(const OrthancPlugins::IDicomDataset& dicom) |
| 0 | 112 { |
| 32 | 113 std::string a, b; |
| 114 | |
| 115 if (dicom.GetStringValue(a, OrthancPlugins::DICOM_TAG_IMAGE_POSITION_PATIENT) && | |
| 116 dicom.GetStringValue(b, OrthancPlugins::DICOM_TAG_IMAGE_ORIENTATION_PATIENT)) | |
| 0 | 117 { |
| 32 | 118 Setup(a, b); |
| 0 | 119 } |
| 120 else | |
| 121 { | |
| 122 SetupCanonical(); | |
| 123 } | |
|
122
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
124 } |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
125 |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
126 |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
127 CoordinateSystem3D::CoordinateSystem3D(const Orthanc::DicomMap& dicom) |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
128 { |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
129 std::string a, b; |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
130 |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
131 if (dicom.CopyToString(a, Orthanc::DICOM_TAG_IMAGE_POSITION_PATIENT, false) && |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
132 dicom.CopyToString(b, Orthanc::DICOM_TAG_IMAGE_ORIENTATION_PATIENT, false)) |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
133 { |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
134 Setup(a, b); |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
135 } |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
136 else |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
137 { |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
138 SetupCanonical(); |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
139 } |
|
e3433dabfb8d
refactoring DicomStructureSet
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
113
diff
changeset
|
140 } |
| 0 | 141 |
| 142 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
143 Vector CoordinateSystem3D::MapSliceToWorldCoordinates(double x, |
|
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
144 double y) const |
| 0 | 145 { |
| 146 return origin_ + x * axisX_ + y * axisY_; | |
| 147 } | |
| 148 | |
| 149 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
150 double CoordinateSystem3D::ProjectAlongNormal(const Vector& point) const |
| 0 | 151 { |
| 152 return boost::numeric::ublas::inner_prod(point, normal_); | |
| 153 } | |
| 154 | |
| 155 | |
|
110
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
156 void CoordinateSystem3D::ProjectPoint(double& offsetX, |
|
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
157 double& offsetY, |
|
53025eecbc95
renamed SliceGeometry as CoordinateSystem3D
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
89
diff
changeset
|
158 const Vector& point) const |
| 0 | 159 { |
| 160 // Project the point onto the slice | |
| 161 Vector projection; | |
| 162 GeometryToolbox::ProjectPointOntoPlane(projection, point, normal_, origin_); | |
| 163 | |
| 164 // As the axes are orthonormal vectors thanks to | |
| 165 // CheckAndComputeNormal(), the following dot products give the | |
| 166 // offset of the origin of the slice wrt. the origin of the | |
| 167 // reference plane https://en.wikipedia.org/wiki/Vector_projection | |
| 168 offsetX = boost::numeric::ublas::inner_prod(axisX_, projection - origin_); | |
| 169 offsetY = boost::numeric::ublas::inner_prod(axisY_, projection - origin_); | |
| 170 } | |
|
151
c5044bbfc303
CoordinateSystem3D::IntersectSegment()
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
135
diff
changeset
|
171 |
|
c5044bbfc303
CoordinateSystem3D::IntersectSegment()
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
135
diff
changeset
|
172 |
| 152 | 173 bool CoordinateSystem3D::IntersectSegment(Vector& p, |
|
151
c5044bbfc303
CoordinateSystem3D::IntersectSegment()
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
135
diff
changeset
|
174 const Vector& edgeFrom, |
|
c5044bbfc303
CoordinateSystem3D::IntersectSegment()
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
135
diff
changeset
|
175 const Vector& edgeTo) const |
|
c5044bbfc303
CoordinateSystem3D::IntersectSegment()
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
135
diff
changeset
|
176 { |
|
c5044bbfc303
CoordinateSystem3D::IntersectSegment()
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
135
diff
changeset
|
177 double d = -(normal_[0] * origin_[0] + normal_[1] * origin_[1] + normal_[2] * origin_[2]); |
| 152 | 178 return GeometryToolbox::IntersectPlaneAndSegment(p, normal_, d, edgeFrom, edgeTo); |
|
151
c5044bbfc303
CoordinateSystem3D::IntersectSegment()
Sebastien Jodogne <s.jodogne@gmail.com>
parents:
135
diff
changeset
|
179 } |
| 0 | 180 } |