comparison align/DTW.h @ 772:8280f7a363d1 pitch-align

Prefer diagonal if the cost is the same - this makes the results the same as our earlier test aligner

 #define SV_DTW_H
 
 #include <vector>
 #include <functional>
 
+//#define DEBUG_DTW 1
+
 template <typename Value>
 class DTW
 {
 public:
     DTW(std::function<double(const Value &, const Value &)> distanceMetric) :

             return alignment;
         }
 
         auto costs = costSeries(s1, s2);
 
+#ifdef DEBUG_DTW
+        SVCERR << "Cost matrix:" << endl;
+        for (auto v: costs) {
+            for (auto x: v) {
+                SVCERR << x << " ";
+            }
+            SVCERR << "\n";
+        }
+#endif
+        
         size_t j = s1.size() - 1;
         size_t i = s2.size() - 1;
 
         while (j > 0 && i > 0) {
 

             cost_t b = costs[j][i-1];
             cost_t both = costs[j-1][i-1];
 
             if (a < b) {
                 --j;
-                if (both < a) {
+                if (both <= a) {
                     --i;
                 }
             } else {
                 --i;
-                if (both < b) {
+                if (both <= b) {
                     --j;
                 }
             }
         }