Colony » Colony Scout

#ifndef _SCHEDULER_

#define _SCHEDULER_

#include "../helper_classes/PQWrapper.h"

#include "../helper_classes/Order.h"

#include "../Behavior.h"

#define NUM_TASKS 5

typedef struct{

  std::string name;

  ros::Subscriber topic;

} Robot;

class Scheduler : Behavior {

  std::vector<Robot> robots;

  PQWrapper* unassignedOrders;

        std::vector<Order> assignedOrders;

        std::queue<Robot> waitingRobots;

        void create_orders();

        void waiting_dance();

  void msg_callback(const std_msgs::String::ConstPtr& msg);

public:

  Scheduler(std::string scoutname);

        ~Scheduler();

        void get_task(int robot);

        void task_complete(Order o);

        void task_failed(Order o);

        Order get_next_item();

        void run();

  ros::Publisher sched_to_robot;

};

#endif