kinect_image_flip.h

Go to the documentation of this file.

/****************************************************************
 *
 * Copyright (c) 2010
 *
 * Fraunhofer Institute for Manufacturing Engineering
 * and Automation (IPA)
 *
 * +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 *
 * Project name: care-o-bot
 * ROS stack name: cob_perception_common
 * ROS package name: cob_image_flip
 *
 * +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 *
 * Author: Richard Bormann, email:richard.bormann@ipa.fhg.de
 * Supervised by: Richard Bormann, email:richard.bormann@ipa.fhg.de
 *
 * Date of creation: May 2011
 * ToDo:
 *
 * +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in the
 *       documentation and/or other materials provided with the distribution.
 *     * Neither the name of the Fraunhofer Institute for Manufacturing
 *       Engineering and Automation (IPA) nor the names of its
 *       contributors may be used to endorse or promote products derived from
 *       this software without specific prior written permission.
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License LGPL as
 * published by the Free Software Foundation, either version 3 of the
 * License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU Lesser General Public License LGPL for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License LGPL along with this program.
 * If not, see <http://www.gnu.org/licenses/>.
 *
 ****************************************************************/

//##################
//#### includes ####

// ROS includes
#include <ros/ros.h>

// ROS message includes
#include <sensor_msgs/Image.h>
#include <sensor_msgs/PointCloud2.h>
#include <tf/transform_listener.h>

// topics
//#include <message_filters/subscriber.h>
//#include <message_filters/synchronizer.h>
//#include <message_filters/sync_policies/approximate_time.h>
#include <image_transport/image_transport.h>
#include <image_transport/subscriber_filter.h>

// opencv
#include <opencv/cv.h>
#include <opencv/highgui.h>
#include <cv_bridge/cv_bridge.h>
#include <sensor_msgs/image_encodings.h>

// point cloud
#include <pcl/point_types.h>
#include <pcl_ros/point_cloud.h>

// timer
#include <cob_image_flip/timer.h>

// System
#include <iostream>

#include <cob_vision_utils/GlobalDefines.h>

namespace cob_image_flip
{
class CobKinectImageFlip
{
protected:
        int cob3Number_;
        bool flip_color_image_;
        bool flip_pointcloud_;
        std::string pointcloud_data_format_;
        bool display_warnings_;
        bool display_timing_;

        unsigned int img_sub_counter_;
        unsigned int pc_sub_counter_;

        ros::Subscriber point_cloud_sub_;
        ros::Publisher point_cloud_pub_; 
        //message_filters::Subscriber<sensor_msgs::PointCloud2> point_cloud_sub_;       ///< Point cloud input topic
        image_transport::ImageTransport* it_;
        image_transport::SubscriberFilter color_camera_image_sub_;      
        image_transport::Publisher color_camera_image_pub_;             
        //message_filters::Synchronizer<message_filters::sync_policies::ApproximateTime<sensor_msgs::PointCloud2, sensor_msgs::Image> >* sync_pointcloud_;      ///< synchronizer for input data
        //message_filters::Connection sync_pointcloud_callback_connection_;

        tf::TransformListener* transform_listener_;

        ros::NodeHandle node_handle_; 

public:

        CobKinectImageFlip(ros::NodeHandle nh);

        ~CobKinectImageFlip();

        unsigned long init();

        unsigned long convertColorImageMessageToMat(const sensor_msgs::Image::ConstPtr& color_image_msg, cv_bridge::CvImageConstPtr& color_image_ptr, cv::Mat& color_image);

        template <typename T>
        void inputCallback(const sensor_msgs::PointCloud2::ConstPtr& point_cloud_msg);

        void imageCallback(const sensor_msgs::ImageConstPtr& color_image_msg);

        void imgConnectCB(const image_transport::SingleSubscriberPublisher& pub);
        
        void imgDisconnectCB(const image_transport::SingleSubscriberPublisher& pub);

        void pcConnectCB(const ros::SingleSubscriberPublisher& pub);
        
        void pcDisconnectCB(const ros::SingleSubscriberPublisher& pub);
};

}