Image Component Library (ICL)
|
00001 /******************************************************************** 00002 ** Image Component Library (ICL) ** 00003 ** ** 00004 ** Copyright (C) 2006-2013 CITEC, University of Bielefeld ** 00005 ** Neuroinformatics Group ** 00006 ** Website: www.iclcv.org and ** 00007 ** http://opensource.cit-ec.de/projects/icl ** 00008 ** ** 00009 ** File : ICLMath/src/ICLMath/Homography2D.h ** 00010 ** Module : ICLMath ** 00011 ** Authors: Christof Elbrechter ** 00012 ** ** 00013 ** ** 00014 ** GNU LESSER GENERAL PUBLIC LICENSE ** 00015 ** This file may be used under the terms of the GNU Lesser General ** 00016 ** Public License version 3.0 as published by the ** 00017 ** ** 00018 ** Free Software Foundation and appearing in the file LICENSE.GPL ** 00019 ** included in the packaging of this file. Please review the ** 00020 ** following information to ensure the license requirements will ** 00021 ** be met: http://www.gnu.org/licenses/lgpl-3.0.txt ** 00022 ** ** 00023 ** The development of this software was supported by the ** 00024 ** Excellence Cluster EXC 277 Cognitive Interaction Technology. ** 00025 ** The Excellence Cluster EXC 277 is a grant of the Deutsche ** 00026 ** Forschungsgemeinschaft (DFG) in the context of the German ** 00027 ** Excellence Initiative. ** 00028 ** ** 00029 ********************************************************************/ 00030 00031 #pragma once 00032 00033 #include <ICLMath/FixedMatrix.h> 00034 #include <ICLUtils/Point32f.h> 00035 00036 namespace icl{ 00037 namespace math{ 00038 00040 00154 template<class T> 00155 struct GenericHomography2D : public FixedMatrix<T,3,3>{ 00157 typedef FixedMatrix<T,3,3> Super; 00158 00160 enum Algorithm{ 00161 Simple, 00162 Advanced, 00163 }; 00164 00166 GenericHomography2D(){} 00167 00169 GenericHomography2D(const utils::Point32f *pAs, const utils::Point32f *pBs, int n=4, Algorithm algo = Advanced); 00170 00171 00173 static inline utils::Point32f apply_homography(const FixedMatrix<float,3,3> &H, const utils::Point32f &p){ 00174 float az = H(0,2)*p.x + H(1,2) * p.y + H(2,2); 00175 return utils::Point32f(( H(0,0)*p.x + H(1,0) * p.y + H(2,0) ) / az, 00176 ( H(0,1)*p.x + H(1,1) * p.y + H(2,1) ) / az ); 00177 } 00178 00180 inline utils::Point32f apply(const utils::Point32f &p) const{ 00181 return apply_homography(*this,p); 00182 } 00183 00185 static inline utils::Point apply_homography_int(const FixedMatrix<float,3,3> &H, const utils::Point &p){ 00186 float az = H(0,2)*p.x + H(1,2) * p.y + H(2,2); 00187 return utils::Point(round(( H(0,0)*p.x + H(1,0) * p.y + H(2,0) ) / az), 00188 round(( H(0,1)*p.x + H(1,1) * p.y + H(2,1) ) / az) ); 00189 } 00190 00192 inline utils::Point32f apply_int(const utils::Point32f &p) const{ 00193 return apply_homography_int(*this, p); 00194 } 00195 }; 00196 00198 typedef GenericHomography2D<float> Homography2D; 00199 00200 00201 } // namespace math 00202 } 00203