NOOP, remove trailing tabs/whitespace.
[ardour.git] / libs / ardour / midi_buffer.cc
index 0b0e61000de81cbfd5af13e6e11c26fc3f570761..dc8deb7727a723ffd1f91e0209a4935db1756bba 100644 (file)
@@ -22,6 +22,7 @@
 #include "pbd/malign.h"
 #include "pbd/compose.h"
 #include "pbd/debug.h"
+#include "pbd/stacktrace.h"
 
 #include "ardour/debug.h"
 #include "ardour/midi_buffer.h"
@@ -32,34 +33,39 @@ using namespace PBD;
 
 // FIXME: mirroring for MIDI buffers?
 MidiBuffer::MidiBuffer(size_t capacity)
-       : Buffer(DataType::MIDI, capacity)
-       , _data(0)
+       : Buffer (DataType::MIDI)
+       , _data (0)
 {
        if (capacity) {
-               resize(_capacity);
-               silence(_capacity);
+               resize (capacity);
+               silence (capacity);
        }
 }
 
 MidiBuffer::~MidiBuffer()
 {
-       free(_data);
+       cache_aligned_free(_data);
 }
 
 void
 MidiBuffer::resize(size_t size)
 {
-       assert(size > 0);
+       if (_data && size < _capacity) {
+
+               if (_size < size) {
+                       /* truncate */
+                       _size = size;
+               }
 
-       if (size < _capacity) {
                return;
        }
 
-       free(_data);
+       cache_aligned_free (_data);
+
+       cache_aligned_malloc ((void**) &_data, size);
 
        _size = 0;
        _capacity = size;
-       cache_aligned_malloc ((void**) &_data, _capacity);
 
        assert(_data);
 }
@@ -133,6 +139,7 @@ MidiBuffer::push_back(const Evoral::MIDIEvent<TimeType>& ev)
 
        if (_size + stamp_size + ev.size() >= _capacity) {
                cerr << "MidiBuffer::push_back failed (buffer is full)" << endl;
+               PBD::stacktrace (cerr, 20);
                return false;
        }
 
@@ -156,7 +163,7 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data)
        const size_t stamp_size = sizeof(TimeType);
 
 #ifndef NDEBUG
-       if (DEBUG::MidiIO & PBD::debug_bits) {
+       if (DEBUG_ENABLED(DEBUG::MidiIO)) {
                DEBUG_STR_DECL(a);
                DEBUG_STR_APPEND(a, string_compose ("midibuffer %1 push event @ %2 sz %3 ", this, time, size));
                for (size_t i=0; i < size; ++i) {
@@ -171,7 +178,9 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data)
 #endif
 
        if (_size + stamp_size + size >= _capacity) {
-               cerr << "MidiBuffer::push_back failed (buffer is full)" << endl;
+               cerr << "MidiBuffer::push_back2 failed (buffer is full; _size = " << _size << " capacity "
+                    << _capacity << " stamp " << stamp_size << " size = " << size << ")" << endl;
+               PBD::stacktrace (cerr, 20);
                return false;
        }
 
@@ -181,7 +190,7 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data)
        }
 
        uint8_t* const write_loc = _data + _size;
-       *((TimeType*)write_loc) = time;
+       *(reinterpret_cast<TimeType*>((uintptr_t)write_loc)) = time;
        memcpy(write_loc + stamp_size, data, size);
 
        _size += stamp_size + size;
@@ -190,6 +199,64 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data)
        return true;
 }
 
+bool
+MidiBuffer::insert_event(const Evoral::MIDIEvent<TimeType>& ev)
+{
+       if (size() == 0) {
+               return push_back(ev);
+       }
+
+       const size_t stamp_size = sizeof(TimeType);
+       const size_t bytes_to_merge = stamp_size + ev.size();
+
+       if (_size + bytes_to_merge >= _capacity) {
+               cerr << "MidiBuffer::push_back failed (buffer is full)" << endl;
+               PBD::stacktrace (cerr, 20);
+               return false;
+       }
+
+       TimeType t = ev.time();
+
+       ssize_t insert_offset = -1;
+       for (MidiBuffer::iterator m = begin(); m != end(); ++m) {
+               if ((*m).time() < t) {
+                       continue;
+               }
+               if ((*m).time() == t) {
+                       const uint8_t our_midi_status_byte = *(_data + m.offset + sizeof (TimeType));
+                       if (second_simultaneous_midi_byte_is_first (ev.type(), our_midi_status_byte)) {
+                               continue;
+                       }
+               }
+               insert_offset = m.offset;
+               break;
+       }
+       if (insert_offset == -1) {
+               return push_back(ev);
+       }
+
+       // don't use memmove - it may use malloc(!)
+       // memmove (_data + insert_offset + bytes_to_merge, _data + insert_offset, _size - insert_offset);
+       for (ssize_t a = _size + bytes_to_merge - 1, b = _size - 1; b >= insert_offset; --b, --a) {
+               _data[a] = _data[b];
+       }
+
+       uint8_t* const write_loc = _data + insert_offset;
+       *(reinterpret_cast<TimeType*>((uintptr_t)write_loc)) = t;
+       memcpy(write_loc + stamp_size, ev.buffer(), ev.size());
+
+       _size += bytes_to_merge;
+
+       return true;
+}
+
+uint32_t
+MidiBuffer::write(TimeType time, Evoral::EventType type, uint32_t size, const uint8_t* buf)
+{
+       insert_event(Evoral::MIDIEvent<TimeType>(type, time, size, const_cast<uint8_t*>(buf)));
+       return size;
+}
+
 /** Reserve space for a new event in the buffer.
  *
  * This call is for copying MIDI directly into the buffer, the data location
@@ -207,7 +274,7 @@ MidiBuffer::reserve(TimeType time, size_t size)
 
        // write timestamp
        uint8_t* write_loc = _data + _size;
-       *((TimeType*)write_loc) = time;
+       *(reinterpret_cast<TimeType*>((uintptr_t)write_loc)) = time;
 
        // move write_loc to begin of MIDI buffer data to write to
        write_loc += stamp_size;
@@ -237,9 +304,9 @@ MidiBuffer::second_simultaneous_midi_byte_is_first (uint8_t a, uint8_t b)
 
        /* two events at identical times. we need to determine
           the order in which they should occur.
-          
+
           the rule is:
-          
+
           Controller messages
           Program Change
           Note Off
@@ -248,22 +315,22 @@ MidiBuffer::second_simultaneous_midi_byte_is_first (uint8_t a, uint8_t b)
           Channel Pressure
           Pitch Bend
        */
-       
+
        if ((a) >= 0xf0 || (b) >= 0xf0 || ((a & 0xf) != (b & 0xf))) {
-               
+
                /* if either message is not a channel message, or if the channels are
                 * different, we don't care about the type.
                 */
-               
+
                b_first = true;
-               
+
        } else {
-               
+
                switch (b & 0xf0) {
                case MIDI_CMD_CONTROL:
                        b_first = true;
                        break;
-                       
+
                case MIDI_CMD_PGM_CHANGE:
                        switch (a & 0xf0) {
                        case MIDI_CMD_CONTROL:
@@ -277,7 +344,7 @@ MidiBuffer::second_simultaneous_midi_byte_is_first (uint8_t a, uint8_t b)
                                b_first = true;
                        }
                        break;
-                       
+
                case MIDI_CMD_NOTE_OFF:
                        switch (a & 0xf0) {
                        case MIDI_CMD_CONTROL:
@@ -291,7 +358,7 @@ MidiBuffer::second_simultaneous_midi_byte_is_first (uint8_t a, uint8_t b)
                                b_first = true;
                        }
                        break;
-                       
+
                case MIDI_CMD_NOTE_ON:
                        switch (a & 0xf0) {
                        case MIDI_CMD_CONTROL:
@@ -318,7 +385,7 @@ MidiBuffer::second_simultaneous_midi_byte_is_first (uint8_t a, uint8_t b)
                                b_first = true;
                        }
                        break;
-                       
+
                case MIDI_CMD_CHANNEL_PRESSURE:
                        switch (a & 0xf0) {
                        case MIDI_CMD_CONTROL:
@@ -347,10 +414,10 @@ MidiBuffer::second_simultaneous_midi_byte_is_first (uint8_t a, uint8_t b)
                        break;
                }
        }
-       
+
        return b_first;
 }
-       
+
 /** Merge \a other into this buffer.  Realtime safe. */
 bool
 MidiBuffer::merge_in_place (const MidiBuffer &other)
@@ -407,7 +474,7 @@ MidiBuffer::merge_in_place (const MidiBuffer &other)
                 * if "sz" is non-zero, there is data to be merged from "other"
                 * into this buffer before we do anything else, corresponding
                 * to the events from "other" that we skipped while advancing
-                * "them". 
+                * "them".
                 */
 
                if (bytes_to_merge) {
@@ -421,7 +488,7 @@ MidiBuffer::merge_in_place (const MidiBuffer &other)
                        memcpy  (_data + us.offset, other._data + merge_offset, bytes_to_merge);
                        /* update iterator to our own events. this is a miserable hack */
                        us.offset += bytes_to_merge;
-               } 
+               }
 
                /* if we're at the end of the other buffer, we're done */
 
@@ -435,25 +502,25 @@ MidiBuffer::merge_in_place (const MidiBuffer &other)
 
                if ((*us).time() == (*them).time()) {
 
-                       DEBUG_TRACE (DEBUG::MidiIO, 
+                       DEBUG_TRACE (DEBUG::MidiIO,
                                     string_compose ("simultaneous MIDI events discovered during merge, times %1/%2 status %3/%4\n",
                                                     (*us).time(), (*them).time(),
                                                     (int) *(_data + us.offset + sizeof (TimeType)),
                                                     (int) *(other._data + them.offset + sizeof (TimeType))));
-                       
+
                        uint8_t our_midi_status_byte = *(_data + us.offset + sizeof (TimeType));
                        uint8_t their_midi_status_byte = *(other._data + them.offset + sizeof (TimeType));
                        bool them_first = second_simultaneous_midi_byte_is_first (our_midi_status_byte, their_midi_status_byte);
-                       
+
                        DEBUG_TRACE (DEBUG::MidiIO, string_compose ("other message came first ? %1\n", them_first));
-                       
+
                        if (!them_first) {
                                /* skip past our own event */
                                ++us;
                        }
-                               
+
                        bytes_to_merge = sizeof (TimeType) + (*them).size();
-                       
+
                        /* move our remaining events later in the buffer by
                         * enough to fit the one message we're going to merge
                         */
@@ -472,7 +539,7 @@ MidiBuffer::merge_in_place (const MidiBuffer &other)
                        if (them_first) {
                                /* need to skip the event pointed to by 'us'
                                   since its at the same time as 'them'
-                                  (still), and we'll enter 
+                                  (still), and we'll enter
                                */
 
                                if (us != end()) {
@@ -487,11 +554,11 @@ MidiBuffer::merge_in_place (const MidiBuffer &other)
                        ++them;
 
                } else {
-                       
+
                        /* advance past our own events to get to the correct insertion
                           point for the next event(s) from "other"
                        */
-               
+
                        while (us != end() && (*us).time() <= (*them).time()) {
                                ++us;
                        }
@@ -504,12 +571,12 @@ MidiBuffer::merge_in_place (const MidiBuffer &other)
                if (us == end()) {
 
                        /* just append the rest of other and we're done*/
-                       
+
                        memcpy (_data + us.offset, other._data + them.offset, other._size - them.offset);
                        _size += other._size - them.offset;
                        assert(_size <= _capacity);
                        break;
-               } 
+               }
        }
 
        return true;