TNeighborAgentMapProps.h

Go to the documentation of this file.

/* +---------------------------------------------------------------------------+
   |                     Mobile Robot Programming Toolkit (MRPT)               |
   |                          http://www.mrpt.org/                             |
   |                                                                           |
   | Copyright (c) 2005-2016, Individual contributors, see AUTHORS file        |
   | See: http://www.mrpt.org/Authors - All rights reserved.                   |
   | Released under BSD License. See details in http://www.mrpt.org/License    |
   +---------------------------------------------------------------------------+
 */
#pragma once

#include <ros/ros.h>
#include <nav_msgs/OccupancyGrid.h>
#include <nav_msgs/Path.h>
#include <mrpt/ros1bridge/map.h>
#include <mrpt_msgs/GraphSlamAgents.h>
#include <mrpt/system/COutputLogger.h>
#include <mrpt/maps/COccupancyGridMap2D.h>
#include <mrpt/math/utils.h>

namespace mrpt
{
namespace graphslam
{
struct TNeighborAgentMapProps
{
        TNeighborAgentMapProps(
                mrpt::system::COutputLogger* logger_in,
                const mrpt_msgs::GraphSlamAgent& agent_in, ros::NodeHandle* nh_in);

        void readROSParameters();
        void setupComm();
        void setupSubs();
        void setupPubs();
        void updateGridMap(const nav_msgs::OccupancyGrid::ConstPtr& nav_gridmap);
        void updateRobotTrajectory(const nav_msgs::Path::ConstPtr& nav_robot_traj);

        size_t getNodeCount() { return nav_robot_trajectory->poses.size(); }

        mrpt::system::COutputLogger* m_logger;
        ros::NodeHandle* nh;
        const mrpt_msgs::GraphSlamAgent& agent;
        nav_msgs::OccupancyGrid::ConstPtr nav_map;
        nav_msgs::Path::ConstPtr nav_robot_trajectory;
        ros::Subscriber map_sub;
        ros::Subscriber robot_trajectory_sub;
        std::string map_topic;
        std::string robot_trajectory_topic;
        size_t queue_size;
        bool has_init_class;
        bool has_setup_comm;

};      // end of TNeighborAgentMapProps

}  // namespace graphslam
}  // namespace mrpt