nodelets/viewer.cpp

Go to the documentation of this file.

#include <boost/bind.hpp>
#include <boost/make_shared.hpp>
#include <boost/shared_ptr.hpp>
#include <boost/thread.hpp>

#include <nodelet/nodelet.h>
#include <pluginlib/class_list_macros.h>

#include "tracker-viewer.hh"

namespace visp_tracker
{
  class TrackerViewerNodelet : public nodelet::Nodelet
  {
  public:
    TrackerViewerNodelet ()
      : nodelet::Nodelet (),
        exiting_ (false),
        trackerViewer_ (),
        thread_ ()
    {}

    ~TrackerViewerNodelet ()
    {
      exiting_ = true;
      if (thread_)
        if (!thread_->timed_join (boost::posix_time::seconds (2)))
          NODELET_WARN ("failed to join thread but continuing anyway");
      thread_.reset ();
      trackerViewer_.reset ();
    }

    void spin ()
    {
      trackerViewer_ = boost::shared_ptr<visp_tracker::TrackerViewer>
        (new visp_tracker::TrackerViewer
         (getMTNodeHandle (),
          getMTPrivateNodeHandle (),
          exiting_, 5u));
      while (ros::ok () && !exiting_)
        trackerViewer_->spin ();
    }

    virtual void onInit ()
    {
      NODELET_DEBUG ("Initializing nodelet...");
      exiting_ = false;
      thread_ = boost::make_shared<boost::thread>
        (boost::bind (&TrackerViewerNodelet::spin, this));
    }
  private:
    volatile bool exiting_;
    boost::shared_ptr<visp_tracker::TrackerViewer> trackerViewer_;
    boost::shared_ptr<boost::thread> thread_;
  };

} // end of namespace visp_tracker.

PLUGINLIB_DECLARE_CLASS(visp_tracker, TrackerViewer,
                        visp_tracker::TrackerViewerNodelet, nodelet::Nodelet);