pcl: transformation_estimation_point_to_plane

Go to the documentation of this file.
00001 /*
00002  * Software License Agreement (BSD License)
00003  *
00004  *  Point Cloud Library (PCL) - www.pointclouds.org
00005  *  Copyright (c) 2010-2011, Willow Garage, Inc.
00006  *  Copyright (c) 2012-, Open Perception, Inc.
00007  *
00008  *  All rights reserved.
00009  *
00010  *  Redistribution and use in source and binary forms, with or without
00011  *  modification, are permitted provided that the following conditions
00012  *  are met:
00013  *
00014  *   * Redistributions of source code must retain the above copyright
00015  *     notice, this list of conditions and the following disclaimer.
00016  *   * Redistributions in binary form must reproduce the above
00017  *     copyright notice, this list of conditions and the following
00018  *     disclaimer in the documentation and/or other materials provided
00019  *     with the distribution.
00020  *   * Neither the name of the copyright holder(s) nor the names of its
00021  *     contributors may be used to endorse or promote products derived
00022  *     from this software without specific prior written permission.
00023  *
00024  *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
00025  *  "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
00026  *  LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
00027  *  FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
00028  *  COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
00029  *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
00030  *  BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
00031  *  LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
00032  *  CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
00033  *  LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
00034  *  ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
00035  *  POSSIBILITY OF SUCH DAMAGE.
00036  *
00037  * $Id$
00038  *
00039  */
00040 #ifndef PCL_REGISTRATION_TRANSFORMATION_ESTIMATION_POINT_TO_PLANE_LLS_H_ 
00041 #define PCL_REGISTRATION_TRANSFORMATION_ESTIMATION_POINT_TO_PLANE_LLS_H_
00042 
00043 #include <pcl/registration/transformation_estimation.h>
00044 #include <pcl/registration/warp_point_rigid.h>
00045 #include <pcl/cloud_iterator.h>
00046 
00047 namespace pcl
00048 {
00049   namespace registration
00050   {
00062     template <typename PointSource, typename PointTarget, typename Scalar = float>
00063     class TransformationEstimationPointToPlaneLLS : public TransformationEstimation<PointSource, PointTarget, Scalar>
00064     {
00065       public:
00066         typedef boost::shared_ptr<TransformationEstimationPointToPlaneLLS<PointSource, PointTarget, Scalar> > Ptr;
00067         typedef boost::shared_ptr<const TransformationEstimationPointToPlaneLLS<PointSource, PointTarget, Scalar> > ConstPtr;
00068 
00069         typedef typename TransformationEstimation<PointSource, PointTarget, Scalar>::Matrix4 Matrix4;
00070         
00071         TransformationEstimationPointToPlaneLLS () {};
00072         virtual ~TransformationEstimationPointToPlaneLLS () {};
00073 
00079         inline void
00080         estimateRigidTransformation (
00081             const pcl::PointCloud<PointSource> &cloud_src,
00082             const pcl::PointCloud<PointTarget> &cloud_tgt,
00083             Matrix4 &transformation_matrix) const;
00084 
00091         inline void
00092         estimateRigidTransformation (
00093             const pcl::PointCloud<PointSource> &cloud_src,
00094             const std::vector<int> &indices_src,
00095             const pcl::PointCloud<PointTarget> &cloud_tgt,
00096             Matrix4 &transformation_matrix) const;
00097 
00105         inline void
00106         estimateRigidTransformation (
00107             const pcl::PointCloud<PointSource> &cloud_src,
00108             const std::vector<int> &indices_src,
00109             const pcl::PointCloud<PointTarget> &cloud_tgt,
00110             const std::vector<int> &indices_tgt,
00111             Matrix4 &transformation_matrix) const;
00112 
00119         inline void
00120         estimateRigidTransformation (
00121             const pcl::PointCloud<PointSource> &cloud_src,
00122             const pcl::PointCloud<PointTarget> &cloud_tgt,
00123             const pcl::Correspondences &correspondences,
00124             Matrix4 &transformation_matrix) const;
00125 
00126       protected:
00127         
00133         void 
00134         estimateRigidTransformation (ConstCloudIterator<PointSource>& source_it, 
00135                                      ConstCloudIterator<PointTarget>& target_it, 
00136                                      Matrix4 &transformation_matrix) const;
00137 
00147         inline void
00148         constructTransformationMatrix (const double & alpha, const double & beta, const double & gamma,
00149                                        const double & tx,    const double & ty,   const double & tz,
00150                                        Matrix4 &transformation_matrix) const;
00151 
00152     };
00153   }
00154 }
00155 
00156 #include <pcl/registration/impl/transformation_estimation_point_to_plane_lls.hpp>
00157 
00158 #endif /* PCL_REGISTRATION_TRANSFORMATION_ESTIMATION_POINT_TO_PLANE_H_LLS_ */