00001 /************************************************************************************************** 00002 Software License Agreement (BSD License) 00003 00004 Copyright (c) 2011-2013, LAR toolkit developers - University of Aveiro - http://lars.mec.ua.pt 00005 All rights reserved. 00006 00007 Redistribution and use in source and binary forms, with or without modification, are permitted 00008 provided that the following conditions are met: 00009 00010 *Redistributions of source code must retain the above copyright notice, this list of 00011 conditions and the following disclaimer. 00012 *Redistributions in binary form must reproduce the above copyright notice, this list of 00013 conditions and the following disclaimer in the documentation and/or other materials provided 00014 with the distribution. 00015 *Neither the name of the University of Aveiro nor the names of its contributors may be used to 00016 endorse or promote products derived from this software without specific prior written permission. 00017 00018 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR 00019 IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND 00020 FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR 00021 CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 00022 DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 00023 DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER 00024 IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT 00025 OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00026 ***************************************************************************************************/ 00032 #ifndef _FILTERING_H_ 00033 #define _FILTERING_H_ 00034 00035 // ROS includes. 00036 #include <ros/ros.h> 00037 #include <sensor_msgs/PointCloud2.h> 00038 #include <tf/transform_listener.h> 00039 #include <pcl_ros/transforms.h> 00040 00041 // PCL includes 00042 #include <pcl/point_types.h> 00043 #include <pcl/ros/conversions.h> 00044 #include <pcl/filters/voxel_grid.h> 00045 00046 // LAR includes 00047 #include <points_from_volume/points_from_volume.h> 00048 00049 #ifndef PFLN 00050 #define PFLN printf("LINE= %d in FILE=%s \n", __LINE__, __FILE__); 00051 #endif 00052 00053 using namespace std; 00054 using namespace pcl; 00055 00056 00060 template<class T> 00061 class filtering 00062 { 00063 public: 00064 00066 filtering() 00067 { 00068 }; 00069 00071 ~filtering() 00072 { 00073 }; 00074 00075 // VARIABLES 00076 00078 PointCloud<T> pc_in; 00079 00081 PointCloud<T> pc_out; 00082 00084 PointCloud<T> convex_hull; 00085 00087 double voxel_size; 00088 00090 double max_z; 00091 00093 double min_z; 00094 00096 ros::Publisher *pub_ptr; 00097 00099 tf::TransformListener *transform_listener_ptr; 00100 00102 string frame_id; 00103 00104 // FUNCTIONS 00105 00107 void filter(const sensor_msgs::PointCloud2Ptr& msg); 00108 00116 sensor_msgs::PointCloud2 voxel_filter(const sensor_msgs::PointCloud2Ptr& msg_in, double voxel_size); 00117 00118 }; 00119 00120 #include "filtering.hpp" 00121 00122 #endif