//////////////////////////////////////////////////////////////////////
MTPGraph::MTPGraph(int nb_vertices, int nb_edges,
- int *from, int *to,
+ int *vertex_from, int *vertex_to,
int source, int sink) {
_nb_vertices = nb_vertices;
_nb_edges = nb_edges;
}
for(int e = 0; e < nb_edges; e++) {
- _vertices[from[e]].add_leaving_edge(_edges + e);
+ _vertices[vertex_from[e]].add_leaving_edge(_edges + e);
_edges[e].occupied = 0;
_edges[e].id = e;
- _edges[e].origin_vertex = _vertices + from[e];
- _edges[e].terminal_vertex = _vertices + to[e];
+ _edges[e].origin_vertex = _vertices + vertex_from[e];
+ _edges[e].terminal_vertex = _vertices + vertex_to[e];
}
paths = 0;
}
}
+ // The edges from the source to the first time frame
+
for(int l = 0; l < _nb_locations; l++) {
node_from[e] = source;
node_to[e] = 1 + l + 0 * _nb_locations;
e++;
}
- for(int t = 0; t < _nb_time_steps; t++) {
+ // The edges from the last frame to the sink
+
+ for(int l = 0; l < _nb_locations; l++) {
+ node_from[e] = late_pair_node(_nb_time_steps - 1, l);
+ node_to[e] = sink;
+ _edge_lengths[e] = 0.0;
+ e++;
+ }
+
+ // The edges between frames, corresponding to allowed motions
+
+ for(int t = 0; t < _nb_time_steps - 1; t++) {
for(int l = 0; l < _nb_locations; l++) {
- if(t == _nb_time_steps - 1) {
- node_from[e] = late_pair_node(t, l);
- node_to[e] = sink;
- _edge_lengths[e] = 0.0;
- e++;
- } else {
- for(int k = 0; k < _nb_locations; k++) {
- if(allowed_motion[l][k]) {
- node_from[e] = late_pair_node(t, l);
- node_to[e] = early_pair_node(t+1, k);
- _edge_lengths[e] = 0.0;
- e++;
- }
+ for(int k = 0; k < _nb_locations; k++) {
+ if(allowed_motion[l][k]) {
+ node_from[e] = late_pair_node(t, l);
+ node_to[e] = early_pair_node(t+1, k);
+ _edge_lengths[e] = 0.0;
+ e++;
}
}
}
}
+ // The edges from the source to the entrances, and from the exits to
+ // the sink
+
for(int t = 0; t < _nb_time_steps; t++) {
for(int l = 0; l < _nb_locations; l++) {
if(t > 0 && entrances[l]) {
}
}
+ // We are done, build the graph
+
_graph = new MTPGraph(nb_vertices, nb_edges,
node_from, node_to,
source, sink);