|
|
1 |
#include <stdlib.h> |
|
|
2 |
#include "tripgraph.h" |
|
|
3 |
|
|
|
4 |
using namespace std; |
|
|
5 |
using namespace tr1; |
|
|
6 |
|
|
|
7 |
|
|
|
8 |
void print_actions(shared_ptr<TripAction> &action) |
|
|
9 |
{ |
|
|
10 |
shared_ptr<TripAction> parent(action->parent); |
|
|
11 |
if (parent) |
|
|
12 |
print_actions(parent); |
|
|
13 |
|
|
|
14 |
printf("%d->%d; route: %d; start time: %.2f; end time: %.2f\n", |
|
|
15 |
action->src_id, action->dest_id, action->route_id, |
|
|
16 |
action->start_time, action->end_time); |
|
|
17 |
} |
|
|
18 |
|
|
|
19 |
|
|
|
20 |
int main(int argc, char *argv[]) |
|
|
21 |
{ |
|
|
22 |
if (argc < 7) |
|
|
23 |
{ |
|
|
24 |
printf("Usage: %s <graph file> <src lat> <src lng> <dest lat> " |
|
|
25 |
"<dest lng> <start time>\n", argv[0]); |
|
|
26 |
return 1; |
|
|
27 |
} |
|
|
28 |
|
|
|
29 |
float src_lat = atof(argv[2]); |
|
|
30 |
float src_lng = atof(argv[3]); |
|
|
31 |
float dest_lat = atof(argv[4]); |
|
|
32 |
float dest_lng = atof(argv[5]); |
|
|
33 |
int start_time = atoi(argv[6]); |
|
|
34 |
|
|
|
35 |
printf("Loading graph...\n"); |
|
|
36 |
TripGraph g; |
|
|
37 |
g.load(argv[1]); |
|
|
38 |
|
|
|
39 |
printf("Calculating path...\n"); |
|
|
40 |
TripPath *p = g.find_path(start_time, false, src_lat, src_lng, |
|
|
41 |
dest_lat, dest_lng); |
|
|
42 |
|
|
|
43 |
if (p) |
|
|
44 |
print_actions(p->last_action); |
|
|
45 |
else |
|
|
46 |
printf("Couldn't find path.\n"); |
|
|
47 |
|
|
|
48 |
delete p; |
|
|
49 |
|
|
|
50 |
return 0; |
|
|
51 |
} |
|
|
52 |
|