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 "physics/physics.h"
#include "transport/TransportTypes.hh"
#include "transport/Node.hh"
#include "common/Time.hh"
#include "common/Plugin.hh"
#include "common/Events.hh"
#include "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