00001 // ---------------------------------------------------------------------------- 00002 // 00003 // $Id$ 00004 // 00005 // Copyright 2008, 2009, 2010, 2011, 2012 Antonio Franchi and Paolo Stegagno 00006 // 00007 // This file is part of MIP. 00008 // 00009 // MIP is free software: you can redistribute it and/or modify 00010 // it under the terms of the GNU General Public License as published by 00011 // the Free Software Foundation, either version 3 of the License, or 00012 // (at your option) any later version. 00013 // 00014 // MIP is distributed in the hope that it will be useful, 00015 // but WITHOUT ANY WARRANTY; without even the implied warranty of 00016 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 00017 // GNU General Public License for more details. 00018 // 00019 // You should have received a copy of the GNU General Public License 00020 // along with MIP. If not, see <http://www.gnu.org/licenses/>. 00021 // 00022 // Contact info: antonio.franchi@tuebingen.mpg.de stegagno@diag.uniroma1.it 00023 // 00024 // ---------------------------------------------------------------------------- 00025 00029 00030 #ifndef __PHD_ID_RANSAC_H 00031 #define __PHD_ID_RANSAC_H 00032 00033 #include <Spaces.h> 00034 #include <armadillo> 00035 #include <math.h> 00036 #include <Gaussian.h> 00037 #include <GaussianMixture.h> 00038 #include <map> 00039 #include <Roulette.h> 00040 00041 #include <PHDRansac.h> 00042 00043 using namespace MipBaselib; 00044 using namespace arma; 00045 00046 namespace MipAlgorithms{ 00047 00049 /* @{ */ 00050 00051 00055 class PHDIDRansacPars : public PHDRansacPars{ 00056 00057 public: 00058 00060 PHDIDRansacPars(int tr=1000); 00061 00063 PHDIDRansacPars(const PHDIDRansacPars &p); 00064 00066 const PHDIDRansacPars& operator=(const PHDIDRansacPars &p); 00067 }; 00068 00069 00073 class PHDIDRansacVars:public PHDRansacVars{ 00074 public: 00075 00077 PHDIDRansacVars(); 00078 }; 00079 00080 00081 00085 class PHDIDRansac :public PHDRansac{ 00086 protected: 00087 PHDIDRansacVars* _idvars; 00088 PHDIDRansacPars* _idpars; 00089 public: 00090 PHDIDRansac(); 00091 00092 PHDIDRansac(PHDIDRansacPars &inParams); 00093 00094 virtual PHDRansacOut step(PHDRansacIn &in); 00095 00096 virtual string print(); 00097 00098 private: 00099 void _gmprewarping(GaussianMixtureJointId &gm); 00100 00101 void _findIdMaps(GaussianMixtureJointId &gm, map<int,vector<int> > &idm, map<int,vector<Decimal> > &szm, vector<int> &ids); 00102 void _findCommonIds(); 00103 void _buildRoulettes(); 00104 void _findBestAssociation(PHDRansacIn &in); 00105 Pose _register(PHDRansacIn &in); 00106 }; 00107 00108 /* @} */ 00109 00110 } 00111 00112 00113 #endif 00114 00115 00116 00117 00118 00119 00120 00121