comparison data/model/AlignmentModel.cpp @ 312:df707a61b23f

* interpolate in AlignmentModel

         float rvalue = (float)frame / (float)m_reference->getSampleRate();
         m_reversePath->addPoint
             (SparseTimeValueModel::Point(rframe, rvalue, ""));
     }
 
-    std::cerr << "AlignmentModel::constructReversePath: " << m_reversePath->getPointCount() << " points" << std::endl;
+    std::cerr << "AlignmentModel::constructReversePath: " << m_reversePath->getPointCount() << " points, at least " << (2 * m_reversePath->getPointCount() * (3 * sizeof(void *) + sizeof(int) + sizeof(SparseTimeValueModel::Point))) << " bytes" << std::endl;
 }
 
 size_t
 AlignmentModel::align(SparseTimeValueModel *path, size_t frame) const
 {

     }        
 
     SparseTimeValueModel::Point point(frame);
     SparseTimeValueModel::PointList::const_iterator i = points.lower_bound(point);
     if (i == points.end()) --i;
-    float time = i->value;
-    size_t rv = lrintf(time * getSampleRate());
-
-    //!!! interpolate!
-
-//    std::cerr << "AlignmentModel::align: rv = " << rv << std::endl;
-
-    return rv;
+    while (i != points.begin() && i->frame > frame) --i;
+
+    long foundFrame = i->frame;
+    float foundTime = i->value;
+
+    long followingFrame = foundFrame;
+    float followingTime = foundTime;
+
+    if (++i != points.end()) {
+        followingFrame = i->frame;
+        followingTime = i->value;
+    }
+
+    float resultTime = foundTime;
+
+    if (followingFrame != foundFrame && frame > foundFrame) {
+
+        std::cerr << "AlignmentModel::align: foundFrame = " << foundFrame << ", frame = " << frame << ", followingFrame = " << followingFrame << std::endl;
+
+        float interp = float(frame - foundFrame) / float(followingFrame - foundFrame);
+        std::cerr << "AlignmentModel::align: interp = " << interp << ", result " << resultTime << " -> ";
+
+        resultTime += (followingTime - foundTime) * interp;
+
+        std::cerr << resultTime << std::endl;
+    }
+
+    size_t resultFrame = lrintf(resultTime * getSampleRate());
+
+    std::cerr << "AlignmentModel::align: resultFrame = " << resultFrame << std::endl;
+
+    return resultFrame;
 }