00001
00002
00003
00004 #ifndef CAJUN_TASK_PLANNER_UTIL_H
00005 #define CAJUN_TASK_PLANNER_UTIL_H
00006
00007 #include "task_planner.H"
00008
00009 namespace cajun
00010 {
00011 void trace_back_global_path (std::deque<task_planner_t *> const &plan_,
00012 unsigned tp_ind_,
00013 unsigned path_start_ind_,
00014 unsigned &LA_tp_ind_,
00015 unsigned &LA_path_ind_,
00016 double &distance_);
00017 double dis_bet_tp_path (std::deque<task_planner_t *> const &plan_,
00018 unsigned tp_id);
00019 };
00020
00021 #endif