targets.h

Go to the documentation of this file.

#ifndef TARGETS_H
#define TARGETS_H

#include <unordered_map>
#include <tf2/utils.h>
#include <geometry_msgs/Pose.h>
#include <geometry_msgs/Transform.h>
#include <swarmros/String.h>
#include <cpswarm_msgs/TargetTracking.h>
#include "target.h"

class targets
{
public:
    targets ();

    void publish (unsigned int id);

    void simulate ();

    void update (geometry_msgs::Pose pose);

    void update (cpswarm_msgs::TargetPositionEvent msg, target_state_t state);

private:
    geometry_msgs::Transform transform (geometry_msgs::Pose p1, geometry_msgs::Pose p2) const;

    void uuid_callback (const swarmros::String::ConstPtr& msg);

    NodeHandle nh;

    Publisher tracking_pub;

    unordered_map<unsigned int, shared_ptr<target>> target_map;

    unordered_map<unsigned int, shared_ptr<target>> simulated_targets;

    string cps;

    double fov;
};

#endif // TARGETS_H