Cosmetics + fixed the entrance in last time frame and exits in first time frame.
[mtp.git] / mtp.cc
1
2 ///////////////////////////////////////////////////////////////////////////
3 // This program is free software: you can redistribute it and/or modify  //
4 // it under the terms of the version 3 of the GNU General Public License //
5 // as published by the Free Software Foundation.                         //
6 //                                                                       //
7 // This program is distributed in the hope that it will be useful, but   //
8 // WITHOUT ANY WARRANTY; without even the implied warranty of            //
9 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU      //
10 // General Public License for more details.                              //
11 //                                                                       //
12 // You should have received a copy of the GNU General Public License     //
13 // along with this program. If not, see <http://www.gnu.org/licenses/>.  //
14 //                                                                       //
15 // Written by and Copyright (C) Francois Fleuret                         //
16 // Contact <francois.fleuret@idiap.ch> for comments & bug reports        //
17 ///////////////////////////////////////////////////////////////////////////
18
19 // Multi-Tracked Path
20
21 #include <iostream>
22 #include <fstream>
23
24 using namespace std;
25
26 #include "tracker.h"
27
28 //////////////////////////////////////////////////////////////////////
29
30 scalar_t detection_score(int true_label, scalar_t flip_noise) {
31   if((true_label > 0) == (drand48() < flip_noise)) {
32     return   1.0 + 0.2 * (drand48() - 0.5);
33   } else {
34     return - 1.0 + 0.2 * (drand48() - 0.5);
35   }
36 }
37
38 int main(int argc, char **argv) {
39   int nb_locations = 6;
40   int nb_time_steps = 5;
41   int motion_amplitude = 1;
42
43   Tracker *tracker = new Tracker(nb_time_steps, nb_locations);
44
45   for(int l = 0; l < nb_locations; l++) {
46     for(int k = 0; k < nb_locations; k++) {
47       tracker->set_allowed_motion(l, k, abs(l - k) <= motion_amplitude);
48     }
49     tracker->set_as_entrance(0, 1);
50     tracker->set_as_exit(nb_locations - 1, 1);
51   }
52
53   tracker->build_graph();
54
55   // We generate synthetic detection scores at location
56   // nb_locations/2, with 5% false detection (FP or FN)
57
58   for(int t = 0; t < nb_time_steps; t++) {
59     for(int l = 0; l < nb_locations; l++) {
60       tracker->set_detection_score(t, l, detection_score(-1, 0.95));
61     }
62     tracker->set_detection_score(t, nb_locations/2, detection_score(1, 0.95));
63   }
64
65   tracker->track();
66
67   for(int t = 0; t < tracker->nb_trajectories(); t++) {
68     cout << "TRAJECTORY "
69          << t
70          << " [starting " << tracker->trajectory_entrance_time(t) << "]";
71     for(int u = 0; u < tracker->trajectory_duration(t); u++) {
72       cout << " " << tracker->trajectory_location(t, u);
73     }
74     cout << endl;
75   }
76
77   {
78     ofstream dot("graph.dot");
79     tracker->print_graph_dot(&dot);
80     cout << "Wrote graph.dot." << endl;
81   }
82
83   delete tracker;
84
85   exit(EXIT_SUCCESS);
86 }