marker_array_plugin.h

Go to the documentation of this file.

/******************************************************************************
 * \file
 *
 * $Id:$
 *
 * Copyright (C) Brno University of Technology
 *
 * This file is part of software developed by dcgm-robotics@FIT group.
 *
 * Author: Vit Stancl (stancl@fit.vutbr.cz)
 * Supervised by: Michal Spanel (spanel@fit.vutbr.cz)
 * Date: dd/mm/2012
 * 
 * This file is free software: you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 * 
 * This file 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 for more details.
 * 
 * You should have received a copy of the GNU Lesser General Public License
 * along with this file.  If not, see <http://www.gnu.org/licenses/>.
 */
#pragma once
#ifndef MarkerArrayPlugin_H_included
#define MarkerArrayPlugin_H_included

#include <srs_env_model/but_server/server_tools.h>

#include <visualization_msgs/MarkerArray.h>
#include <message_filters/subscriber.h>
#include <tf/message_filter.h>

namespace srs_env_model
{

    class CMarkerArrayPlugin : public CServerPluginBase, public COctomapCrawlerBase<tButServerOcTree::NodeType>, public CDataHolderBase< visualization_msgs::MarkerArray >
    {
    public:
        CMarkerArrayPlugin(const std::string & name);

        virtual ~CMarkerArrayPlugin();

        void enable( bool enabled ){ m_publishMarkerArray = enabled; }

        virtual void init(ros::NodeHandle & node_handle);

        virtual void pause( bool bPause, ros::NodeHandle & node_handle );

    protected:
                 virtual void publishInternal(const ros::Time & timestamp);

                 virtual void newMapDataCB( SMapWithParameters & par );

                 virtual void handleNode(const tButServerOcTree::iterator& it, const SMapWithParameters & mp);

                 virtual void handlePostNodeTraversal(const SMapWithParameters & mp);

                 virtual bool shouldPublish();


        std_msgs::ColorRGBA heightMapColor(double h) const;

    public:
      EIGEN_MAKE_ALIGNED_OPERATOR_NEW

    protected:
        bool m_publishMarkerArray;

        std::string m_markerArrayPublisherName;

        ros::Publisher m_markerArrayPublisher;

        tf::TransformListener m_tfListener;

        //
        bool m_latchedTopics;

        std::string m_markerArrayFrameId;

        std::string m_ocFrameId;

        Eigen::Matrix3f m_ocToMarkerArrayRot;

        Eigen::Vector3f m_ocToMarkerArrayTrans;

        double m_minX, m_minY, m_minZ, m_maxX, m_maxY, m_maxZ;

        bool m_bHeightMap;

        bool m_bTransform;

        float m_colorFactor;

        std_msgs::ColorRGBA m_color;

    }; // class CMarkerArrayPlugin

} // namespace srs_env_model



// namespace srs_env_model


// MarkerArrayPlugin_H_included
#endif