gazebo_ros_projector.h

Go to the documentation of this file.

/*
 * Desc: A dynamic controller plugin that controls texture projection.
 * Author: Jared Duke
 * Date: 17 June 2010
 * SVN: $Id$
 */
#ifndef GAZEBO_ROS_PROJECTOR_HH
#define GAZEBO_ROS_PROJECTOR_HH

// Custom Callback Queue
#include <ros/callback_queue.h>
#include <ros/subscribe_options.h>

#include <ros/ros.h>
#include <boost/thread/mutex.hpp>

#include <gazebo/physics/physics.hh>
#include <gazebo/transport/TransportTypes.hh>
#include <gazebo/transport/Node.hh>
#include <gazebo/common/Time.hh>
#include <gazebo/common/Plugin.hh>
#include <gazebo/common/Events.hh>
#include <gazebo/rendering/RenderTypes.hh>

#include <std_msgs/String.h>
#include <std_msgs/Int32.h>

#include <OgrePrerequisites.h>
#include <OgreTexture.h>
#include <OgreFrameListener.h>

namespace Ogre
{
  class PlaneBoundedVolumeListSceneQuery;
  class Frustum;
  class Pass;
  class SceneNode;
}

namespace gazebo
{


class GazeboRosProjector : public ModelPlugin
{
  public: GazeboRosProjector();

  public: virtual ~GazeboRosProjector();

  protected: virtual void Load( physics::ModelPtr _parent, sdf::ElementPtr _sdf );

  private: physics::WorldPtr world_;

  private: void LoadImage(const std_msgs::String::ConstPtr& imageMsg);

  private: void ToggleProjector(const std_msgs::Int32::ConstPtr& projectorMsg);  

  private: ros::NodeHandle* rosnode_;
  private: ros::Subscriber imageSubscriber_;
  private: ros::Subscriber projectorSubscriber_;  

  private: std::string texture_topic_name_;

  private: std::string projector_topic_name_;

  private: std::string robot_namespace_;

  // Custom Callback Queue
  private: ros::CallbackQueue queue_;
  private: void QueueThread();
  private: boost::thread callback_queue_thread_;

  private: event::ConnectionPtr add_model_event_;

  private: transport::NodePtr node_; 
  private: transport::PublisherPtr projector_pub_; 
};



}
#endif