1
1
#include < angles/angles.h>
2
2
#include < srpb_logger/robot_logger.h>
3
3
#include < srpb_logger/people_logger.h>
4
+ #include < srpb_logger/global_planner_logger.h>
4
5
5
6
#include " srpb_evaluation/utils.h"
6
7
7
8
using namespace srpb ::logger;
8
9
using namespace srpb ::evaluation;
9
10
10
11
int main (int argc, char * argv[]) {
11
- if (argc != 5 ) {
12
+ if (argc != 6 ) {
12
13
printf (
13
14
" Please input\r\n "
14
15
" \t * the path to the log file of the robot\r\n "
15
16
" \t * the path to the log file of the people\r\n "
16
17
" \t * the path to the log file of the people groups\r\n "
18
+ " \t * the path to the log file of the global planner\r\n "
17
19
" \t * and value of the safety distance [m].\r\n "
18
20
);
19
21
return 1 ;
@@ -22,7 +24,8 @@ int main(int argc, char* argv[]) {
22
24
auto file_robot = std::string (argv[1 ]);
23
25
auto file_people = std::string (argv[2 ]);
24
26
auto file_groups = std::string (argv[3 ]);
25
- auto safety_distance = std::atof (argv[4 ]);
27
+ auto file_gplanner = std::string (argv[4 ]);
28
+ auto safety_distance = std::atof (argv[5 ]);
26
29
27
30
// goal reached values
28
31
double goal_tolerance_xy = 0.2 ;
@@ -58,6 +61,7 @@ int main(int argc, char* argv[]) {
58
61
auto timed_robot_data = parseFile<RobotData>(file_robot, &RobotLogger::robotFromString);
59
62
auto timed_people_data = parseFile<people_msgs_utils::Person>(file_people, &PeopleLogger::personFromString);
60
63
auto timed_groups_data = parseFile<people_msgs_utils::Group>(file_groups, &PeopleLogger::groupFromString);
64
+ auto timed_gplanner_data = parseFile<GlobalPlannerData>(file_gplanner, &GlobalPlannerLogger::plannerFromString);
61
65
// since Person and Group are logged in separation, so by default Group does not contain members, only their IDs
62
66
timed_groups_data = fillGroupsWithMembers (timed_groups_data, timed_people_data);
63
67
0 commit comments