2014-07-13 21:07:25 +00:00
|
|
|
|
|
|
|
|
#ifndef INFO_DISPLAY_H
|
|
|
|
|
#define INFO_DISPLAY_H
|
|
|
|
|
|
|
|
|
|
#include <rtabmap/Info.h>
|
|
|
|
|
|
|
|
|
|
#include <rviz/message_filter_display.h>
|
2014-07-13 21:27:30 +00:00
|
|
|
#include <rtabmap/core/Transform.h>
|
2014-07-13 21:07:25 +00:00
|
|
|
|
|
|
|
|
namespace rtabmap
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
class InfoDisplay: public rviz::MessageFilterDisplay<rtabmap::Info>
|
|
|
|
|
{
|
|
|
|
|
Q_OBJECT
|
|
|
|
|
public:
|
|
|
|
|
InfoDisplay();
|
|
|
|
|
virtual ~InfoDisplay();
|
|
|
|
|
|
|
|
|
|
virtual void reset();
|
|
|
|
|
virtual void update( float wall_dt, float ros_dt );
|
|
|
|
|
|
|
|
|
|
protected:
|
|
|
|
|
/** @brief Do initialization. Overridden from MessageFilterDisplay. */
|
|
|
|
|
virtual void onInitialize();
|
|
|
|
|
|
|
|
|
|
/** @brief Process a single message. Overridden from MessageFilterDisplay. */
|
|
|
|
|
virtual void processMessage( const rtabmap::InfoConstPtr& cloud );
|
|
|
|
|
|
|
|
|
|
private:
|
|
|
|
|
ros::AsyncSpinner spinner_;
|
|
|
|
|
ros::CallbackQueue cbqueue_;
|
|
|
|
|
|
|
|
|
|
QString info_;
|
|
|
|
|
int globalCount_;
|
|
|
|
|
int localCount_;
|
2014-07-13 21:27:30 +00:00
|
|
|
Transform loopTransform_;
|
2014-07-13 21:07:25 +00:00
|
|
|
boost::mutex info_mutex_;
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
} // namespace rtabmap
|
|
|
|
|
|
|
|
|
|
#endif
|