00001 //=========================================================================== 00002 // GoTools - SINTEF Geometry Tools version 1.1 00003 // 00004 // GoTools module: CORE 00005 // 00006 // Copyright (C) 2000-2007 SINTEF ICT, Applied Mathematics, Norway. 00007 // 00008 // This program is free software; you can redistribute it and/or 00009 // modify it under the terms of the GNU General Public License 00010 // as published by the Free Software Foundation version 2 of the License. 00011 // 00012 // This program is distributed in the hope that it will be useful, 00013 // but WITHOUT ANY WARRANTY; without even the implied warranty of 00014 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 00015 // GNU General Public License for more details. 00016 // 00017 // You should have received a copy of the GNU General Public License 00018 // along with this program; if not, write to the Free Software 00019 // Foundation, Inc., 00020 // 59 Temple Place - Suite 330, 00021 // Boston, MA 02111-1307, USA. 00022 // 00023 // Contact information: E-mail: tor.dokken@sintef.no 00024 // SINTEF ICT, Department of Applied Mathematics, 00025 // P.O. Box 124 Blindern, 00026 // 0314 Oslo, Norway. 00027 // 00028 // Other licenses are also available for this software, notably licenses 00029 // for: 00030 // - Building commercial software. 00031 // - Building software whose source code you wish to keep private. 00032 //=========================================================================== 00033 #ifndef _COORDINATESYSTEM_H 00034 #define _COORDINATESYSTEM_H 00035 00036 #include "Array.h" 00037 #include "MatrixXD.h" 00038 00039 namespace Go 00040 { 00043 00044 00046 00047 template <int Dim> 00048 class CoordinateSystem 00049 { 00050 public: 00051 typedef MatrixXD<double, Dim> Matrix; 00052 typedef Array<double, Dim> Vector; 00053 00056 CoordinateSystem() 00057 { 00058 rotation_.identity(); 00059 translation_.zero(); 00060 } 00061 00064 CoordinateSystem(const Matrix& rot, const Vector& trans) 00065 : rotation_(rot), translation_(trans) 00066 {} 00067 00070 Vector operator* (const Vector& v) 00071 { 00072 return rotation_*v + translation_; 00073 } 00074 00077 CoordinateSystem operator* (const CoordinateSystem& c) 00078 { 00079 Matrix newrot = rotation_*c.rotation_; 00080 Vector newtrans = translation_ + rotation_*c.translation_; 00081 return CoordinateSystem(newrot, newtrans); 00082 } 00083 00085 Matrix& rot() { return rotation_; } 00086 00088 const Matrix& rot() const { return rotation_; } 00089 00091 Vector& tr() { return translation_; } 00092 00094 const Vector& tr() const { return translation_; } 00095 00096 private: 00097 Matrix rotation_; 00098 Vector translation_; 00099 }; 00100 00101 00103 } // namespace Go 00104 00105 00106 00107 #endif // _COORDINATESYSTEM_H 00108 00109