00001 /* 00002 Copyright (c) 2010-2016, Mathieu Labbe - IntRoLab - Universite de Sherbrooke 00003 All rights reserved. 00004 00005 Redistribution and use in source and binary forms, with or without 00006 modification, are permitted provided that the following conditions are met: 00007 * Redistributions of source code must retain the above copyright 00008 notice, this list of conditions and the following disclaimer. 00009 * Redistributions in binary form must reproduce the above copyright 00010 notice, this list of conditions and the following disclaimer in the 00011 documentation and/or other materials provided with the distribution. 00012 * Neither the name of the Universite de Sherbrooke nor the 00013 names of its contributors may be used to endorse or promote products 00014 derived from this software without specific prior written permission. 00015 00016 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND 00017 ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 00018 WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 00019 DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY 00020 DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 00021 (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 00022 LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 00023 ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 00024 (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 00025 SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00026 */ 00027 00028 #ifndef REGISTRATIONICP_H_ 00029 #define REGISTRATIONICP_H_ 00030 00031 #include "rtabmap/core/RtabmapExp.h" // DLL export/import defines 00032 00033 #include <rtabmap/core/Registration.h> 00034 #include <rtabmap/core/Signature.h> 00035 00036 namespace rtabmap { 00037 00038 // Geometrical registration 00039 class RTABMAP_EXP RegistrationIcp : public Registration 00040 { 00041 public: 00042 // take ownership of child 00043 RegistrationIcp(const ParametersMap & parameters = ParametersMap(), Registration * child = 0); 00044 virtual ~RegistrationIcp(); 00045 00046 virtual void parseParameters(const ParametersMap & parameters); 00047 00048 protected: 00049 virtual Transform computeTransformationImpl( 00050 Signature & from, 00051 Signature & to, 00052 Transform guess, 00053 RegistrationInfo & info) const; 00054 virtual bool isScanRequiredImpl() const {return true;} 00055 virtual bool canUseGuessImpl() const {return true;} 00056 virtual float getMinGeometryCorrespondencesRatioImpl() const {return _correspondenceRatio;} 00057 00058 private: 00059 float _maxTranslation; 00060 float _maxRotation; 00061 float _voxelSize; 00062 int _downsamplingStep; 00063 float _maxCorrespondenceDistance; 00064 int _maxIterations; 00065 float _epsilon; 00066 float _correspondenceRatio; 00067 bool _pointToPlane; 00068 int _pointToPlaneK; 00069 float _pointToPlaneRadius; 00070 float _pointToPlaneMinComplexity; 00071 bool _libpointmatcher; 00072 std::string _libpointmatcherConfig; 00073 int _libpointmatcherKnn; 00074 float _libpointmatcherEpsilon; 00075 float _libpointmatcherOutlierRatio; 00076 void * _libpointmatcherICP; 00077 }; 00078 00079 } 00080 00081 #endif /* REGISTRATIONICP_H_ */