MIDClock_Slave: Introduce a 3% deadzone around speed 1.0 to lock in the speed
[ardour.git] / libs / ardour / midi_buffer.cc
index 1e049eba72d6a96df323aa779e5992a197fe4e64..cbf7603c96020f54a80e84cfaa121a4473608de3 100644 (file)
@@ -1,17 +1,17 @@
 /*
-    Copyright (C) 2006-2007 Paul Davis 
+    Copyright (C) 2006-2007 Paul Davis
        Author: Dave Robillard
-    
+
     This program is free software; you can redistribute it and/or modify it
     under the terms of the GNU General Public License as published by the Free
     Software Foundation; either version 2 of the License, or (at your option)
     any later version.
-    
+
     This program is distributed in the hope that it will be useful, but WITHOUT
     ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
     FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
     for more details.
-    
+
     You should have received a copy of the GNU General Public License along
     with this program; if not, write to the Free Software Foundation, Inc.,
     675 Mass Ave, Cambridge, MA 02139, USA.
@@ -34,7 +34,7 @@ MidiBuffer::MidiBuffer(size_t capacity)
                silence(_capacity);
        }
 }
-       
+
 MidiBuffer::~MidiBuffer()
 {
        free(_data);
@@ -79,7 +79,7 @@ MidiBuffer::read_from (const Buffer& src, nframes_t nframes, nframes_t dst_offse
        assert (&src != this);
 
        const MidiBuffer& msrc = (MidiBuffer&) src;
-       
+
        assert (_capacity >= msrc.size());
 
        if (dst_offset == 0) {
@@ -88,7 +88,7 @@ MidiBuffer::read_from (const Buffer& src, nframes_t nframes, nframes_t dst_offse
        }
 
        /* XXX use dst_offset somehow */
-       
+
        for (MidiBuffer::const_iterator i = msrc.begin(); i != msrc.end(); ++i) {
                const Evoral::MIDIEvent<TimeType> ev(*i, false);
                if (ev.time() >= src_offset && ev.time() < (nframes+src_offset)) {
@@ -123,7 +123,7 @@ MidiBuffer::push_back(const Evoral::MIDIEvent<TimeType>& ev)
        const size_t stamp_size = sizeof(TimeType);
        /*cerr << "MidiBuffer: pushing event @ " << ev.time()
                << " size = " << ev.size() << endl;*/
-       
+
        if (_size + stamp_size + ev.size() >= _capacity) {
                cerr << "MidiBuffer::push_back failed (buffer is full)" << endl;
                return false;
@@ -135,7 +135,7 @@ MidiBuffer::push_back(const Evoral::MIDIEvent<TimeType>& ev)
        }
 
        push_back(ev.time(), ev.size(), ev.buffer());
-       
+
        return true;
 }
 
@@ -149,7 +149,7 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data)
        const size_t stamp_size = sizeof(TimeType);
        /*cerr << "MidiBuffer: pushing event @ " << ev.time()
                << " size = " << ev.size() << endl;*/
-       
+
        if (_size + stamp_size + size >= _capacity) {
                cerr << "MidiBuffer::push_back failed (buffer is full)" << endl;
                return false;
@@ -166,7 +166,7 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data)
 
        _size += stamp_size + size;
        _silent = false;
-       
+
        return true;
 }
 
@@ -186,7 +186,7 @@ MidiBuffer::push_back(const jack_midi_event_t& ev)
                cerr << "MidiBuffer::push_back failed (buffer is full)" << endl;
                return false;
        }
-       
+
        if (!Evoral::midi_event_is_valid(ev.buffer, ev.size)) {
                cerr << "WARNING: MidiBuffer ignoring illegal MIDI event" << endl;
                return false;
@@ -198,7 +198,7 @@ MidiBuffer::push_back(const jack_midi_event_t& ev)
 
        _size += stamp_size + ev.size;
        _silent = false;
-       
+
        return true;
 }
 
@@ -221,13 +221,13 @@ MidiBuffer::reserve(TimeType time, size_t size)
        // write timestamp
        uint8_t* write_loc = _data + _size;
        *((TimeType*)write_loc) = time;
-       
+
        // move write_loc to begin of MIDI buffer data to write to
        write_loc += stamp_size;
 
        _size += stamp_size + size;
        _silent = false;
-       
+
        return write_loc;
 }
 
@@ -261,34 +261,59 @@ MidiBuffer::merge_in_place(const MidiBuffer &other)
                return false;
        }
 
+#ifndef NDEBUG
+       size_t   test_orig_us_size   = _size;
+       size_t   test_orig_them_size = other._size;
+       TimeType test_time           = 0;
+       size_t   test_us_count       = 0;
+       size_t   test_them_count     = 0;
+       for (iterator i = begin(); i != end(); ++i) {
+               assert(Evoral::midi_event_is_valid((*i).buffer(), (*i).size()));
+               assert((*i).time() >= test_time);
+               test_time = (*i).time();
+               ++test_us_count;
+       }
+       test_time = 0;
+       for (const_iterator i = other.begin(); i != other.end(); ++i) {
+               assert(Evoral::midi_event_is_valid((*i).buffer(), (*i).size()));
+               assert((*i).time() >= test_time);
+               test_time = (*i).time();
+               ++test_them_count;
+       }
+#endif
+
        const_iterator them = other.begin();
        iterator us = begin();
 
        while (them != other.end()) {
 
-               Evoral::MIDIEvent<TimeType> ev_other (*them);
                size_t sz = 0;
-               size_t src;
+               ssize_t src = -1;
 
                /* gather up total size of events that are earlier than
                   the event referenced by "us"
                */
 
-               src = 0;
-
-               while (them != other.end() && ev_other.time() < (*us).time()) {
-                       if (!src) {
+               while (them != other.end() && (*them).time() <= (*us).time()) {
+                       if (src == -1) {
                                src = them.offset;
                        }
-                       sz += sizeof (TimeType) + ev_other.size();
+                       sz += sizeof (TimeType) + (*them).size();
                        ++them;
                }
 
+               if (us != end())
+                       cerr << "us @ " << (*us).time() << endl;
+               if (them != other.end())
+                       cerr << "them @ " << (*them).time() << endl;
+
                if (sz) {
+                       assert(src >= 0);
                        /* move existing */
-                       memmove (_data + us.offset + sz, _data + us.offset , _size - us.offset);
+                       memmove (_data + us.offset + sz, _data + us.offset, _size - us.offset);
                        /* increase _size */
                        _size += sz;
+                       assert(_size <= _capacity);
                        /* insert new stuff */
                        memcpy  (_data + us.offset, other._data + src, sz);
                        /* update iterator to our own events. this is a miserable hack */
@@ -299,7 +324,7 @@ MidiBuffer::merge_in_place(const MidiBuffer &other)
                           point for the next event(s) from "other"
                        */
 
-                       while (us != end() && (*us).time() < ev_other.time()) {
+                       while (us != end() && (*us).time() < (*them).time()) {
                                ++us;
                        }
                }
@@ -307,10 +332,25 @@ MidiBuffer::merge_in_place(const MidiBuffer &other)
                if (!(us != end())) {
                        /* just append the rest of other */
                        memcpy (_data + us.offset, other._data + them.offset, other._size - them.offset);
+                       _size += other._size - them.offset;
                        break;
                }
        }
 
+#ifndef NDEBUG
+       assert(_size == test_orig_us_size + test_orig_them_size);
+       size_t test_final_count = 0;
+       test_time = 0;
+       for (iterator i = begin(); i != end(); ++i) {
+               cerr << "CHECK " << test_final_count << " / " << test_us_count + test_them_count << endl;
+               assert(Evoral::midi_event_is_valid((*i).buffer(), (*i).size()));
+               assert((*i).time() >= test_time);
+               test_time = (*i).time();
+               ++test_final_count;
+       }
+       assert(test_final_count = test_us_count + test_them_count);
+#endif
+
        return true;
 }
 
@@ -322,16 +362,41 @@ bool
 MidiBuffer::merge(const MidiBuffer& a, const MidiBuffer& b)
 {
        _size = 0;
-       
+
        if (this == &a) {
-           merge_in_place(b);
+           return merge_in_place(b);
+       } else if (this == &b) {
+           return merge_in_place(a);
        }
 
-       if (this == &b) {
-           merge_in_place(a);
+       const_iterator ai = a.begin();
+       const_iterator bi = b.begin();
+
+       resize(a.size() + b.size());
+       while (ai != a.end() && bi != b.end()) {
+               if ((*ai).time() < (*bi).time()) {
+                       memcpy(_data + _size, (*ai).buffer(), (*ai).size());
+                       _size += (*ai).size();
+                       ++ai;
+               } else {
+                       memcpy(_data + _size, (*bi).buffer(), (*bi).size());
+                       _size += (*bi).size();
+                       ++bi;
+               }
+       }
+
+       while (ai != a.end()) {
+               memcpy(_data + _size, (*ai).buffer(), (*ai).size());
+               _size += (*ai).size();
+               ++ai;
        }
-       
-       cerr << "FIXME: MIDI BUFFER MERGE" << endl;
+
+       while (bi != b.end()) {
+               memcpy(_data + _size, (*bi).buffer(), (*bi).size());
+               _size += (*bi).size();
+               ++bi;
+       }
+
        return true;
 }