X-Git-Url: https://main.carlh.net/gitweb/?p=ardour.git;a=blobdiff_plain;f=libs%2Fardour%2Fmidi_buffer.cc;h=41d638dc781fc84d221849bbefc5405344a3e1fc;hp=8299d811f61a4ece460c1dd382db4978a1bc6880;hb=c8c6bca6587450ff64303dbc994a4cd28d6ce7aa;hpb=1e728e728a79d9b272cc18bc1c46f0c3c8831bf8 diff --git a/libs/ardour/midi_buffer.cc b/libs/ardour/midi_buffer.cc index 8299d811f6..41d638dc78 100644 --- a/libs/ardour/midi_buffer.cc +++ b/libs/ardour/midi_buffer.cc @@ -1,6 +1,6 @@ /* Copyright (C) 2006-2007 Paul Davis - Author: Dave Robillard + Author: David 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 @@ -22,9 +22,11 @@ #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" +#include "ardour/port.h" using namespace std; using namespace ARDOUR; @@ -32,34 +34,40 @@ using namespace PBD; // FIXME: mirroring for MIDI buffers? MidiBuffer::MidiBuffer(size_t capacity) - : Buffer(DataType::MIDI, capacity) - , _data(0) + : Buffer (DataType::MIDI) + , _data (0) + , _size (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); } @@ -72,6 +80,14 @@ MidiBuffer::copy(const MidiBuffer& copy) memcpy(_data, copy._data, copy._size); } +void +MidiBuffer::copy(MidiBuffer const * const copy) +{ + assert(_capacity >= copy->size ()); + _size = copy->size (); + memcpy(_data, copy->data(), _size); +} + /** Read events from @a src starting at time @a offset into the START of this buffer, for * time duration @a nframes. Relative time, where 0 = start of buffer. @@ -79,12 +95,12 @@ MidiBuffer::copy(const MidiBuffer& copy) * Note that offset and nframes refer to sample time, NOT buffer offsets or event counts. */ void -MidiBuffer::read_from (const Buffer& src, nframes_t nframes, nframes_t dst_offset, nframes_t src_offset) +MidiBuffer::read_from (const Buffer& src, framecnt_t nframes, framecnt_t dst_offset, framecnt_t /* src_offset*/) { assert (src.type() == DataType::MIDI); assert (&src != this); - const MidiBuffer& msrc = (MidiBuffer&) src; + const MidiBuffer& msrc = (const MidiBuffer&) src; assert (_capacity >= msrc.size()); @@ -93,23 +109,27 @@ MidiBuffer::read_from (const Buffer& src, nframes_t nframes, nframes_t dst_offse assert (_size == 0); } - /* XXX use dst_offset somehow */ + framecnt_t offset = Port::port_offset(); for (MidiBuffer::const_iterator i = msrc.begin(); i != msrc.end(); ++i) { const Evoral::MIDIEvent ev(*i, false); - if (ev.time() >= src_offset && ev.time() < (nframes+src_offset)) { + if (ev.time() >= offset && ev.time() < (nframes + offset)) { push_back (ev); } else { - cerr << "MIDI event @ " << ev.time() << " skipped, not within range " << src_offset << " .. " - << (nframes + src_offset) << endl; - } + cerr << "MIDI event @ " << ev.time() << " skipped, not within range " + << offset << " .. " << (nframes + offset) << ":"; + for (size_t xx = 0; xx < ev.size(); ++xx) { + cerr << ' ' << hex << (int) ev.buffer()[xx]; + } + cerr << dec << endl; + } } _silent = src.silent(); } void -MidiBuffer::merge_from (const Buffer& src, nframes_t /*nframes*/, nframes_t /*dst_offset*/, nframes_t /*src_offset*/) +MidiBuffer::merge_from (const Buffer& src, framecnt_t /*nframes*/, framecnt_t /*dst_offset*/, framecnt_t /*src_offset*/) { const MidiBuffer* mbuf = dynamic_cast(&src); assert (mbuf); @@ -129,27 +149,15 @@ MidiBuffer::merge_from (const Buffer& src, nframes_t /*nframes*/, nframes_t /*ds bool MidiBuffer::push_back(const Evoral::MIDIEvent& 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; - } - - if (!Evoral::midi_event_is_valid(ev.buffer(), ev.size())) { - cerr << "WARNING: MidiBuffer ignoring illegal MIDI event" << endl; - return false; - } - - push_back(ev.time(), ev.size(), ev.buffer()); - - return true; + return push_back (ev.time(), ev.size(), ev.buffer()); } -/** Push an event into the buffer. +/** Push MIDI data into the buffer. + * + * Note that the raw MIDI pointed to by @param data will be COPIED and unmodified. + * That is, the caller still owns it, if it needs freeing it's Not My Problem(TM). + * Realtime safe. * @return false if operation failed (not enough room) */ bool @@ -158,33 +166,30 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data) const size_t stamp_size = sizeof(TimeType); #ifndef NDEBUG - DEBUG_STR_DECL(a); - DEBUG_STR_APPEND(a, string_compose ("midibuffer %1 push event @ %2 sz %3 ", this, time, size)); + 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) { DEBUG_STR_APPEND(a,hex); DEBUG_STR_APPEND(a,"0x"); DEBUG_STR_APPEND(a,(int)data[i]); - DEBUG_STR_APPEND(a,' '); + DEBUG_STR_APPEND(a,' '); } - DEBUG_STR_APPEND(a,'\n'); - DEBUG_TRACE (DEBUG::MidiIO, DEBUG_STR(a).str()); + DEBUG_STR_APPEND(a,'\n'); + DEBUG_TRACE (DEBUG::MidiIO, DEBUG_STR(a).str()); + } #endif - // cerr << "MidiBuffer: pushing event @ " << time - // << " size = " << size << endl; - if (_size + stamp_size + size >= _capacity) { - cerr << "MidiBuffer::push_back failed (buffer is full)" << endl; return false; } if (!Evoral::midi_event_is_valid(data, size)) { - cerr << "WARNING: MidiBuffer ignoring illegal MIDI event" << endl; return false; } uint8_t* const write_loc = _data + _size; - *((TimeType*)write_loc) = time; + *(reinterpret_cast((uintptr_t)write_loc)) = time; memcpy(write_loc + stamp_size, data, size); _size += stamp_size + size; @@ -193,38 +198,63 @@ MidiBuffer::push_back(TimeType time, size_t size, const uint8_t* data) return true; } - -/** Push an event into the buffer. - * - * Note that the raw MIDI pointed to by ev will be COPIED and unmodified. - * That is, the caller still owns it, if it needs freeing it's Not My Problem(TM). - * Realtime safe. - * @return false if operation failed (not enough room) - */ bool -MidiBuffer::push_back(const jack_midi_event_t& ev) +MidiBuffer::insert_event(const Evoral::MIDIEvent& ev) { + if (size() == 0) { + return push_back(ev); + } + const size_t stamp_size = sizeof(TimeType); - if (_size + stamp_size + ev.size >= _capacity) { + 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; } - if (!Evoral::midi_event_is_valid(ev.buffer, ev.size)) { - cerr << "WARNING: MidiBuffer ignoring illegal MIDI event" << endl; - 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); } - uint8_t* const write_loc = _data + _size; - *((TimeType*)write_loc) = ev.time; - memcpy(write_loc + stamp_size, ev.buffer, ev.size); + // 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]; + } - _size += stamp_size + ev.size; - _silent = false; + uint8_t* const write_loc = _data + insert_offset; + *(reinterpret_cast((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(type, time, size, const_cast(buf))); + return size; +} /** Reserve space for a new event in the buffer. * @@ -243,7 +273,7 @@ MidiBuffer::reserve(TimeType time, size_t size) // write timestamp uint8_t* write_loc = _data + _size; - *((TimeType*)write_loc) = time; + *(reinterpret_cast((uintptr_t)write_loc)) = time; // move write_loc to begin of MIDI buffer data to write to write_loc += stamp_size; @@ -256,7 +286,7 @@ MidiBuffer::reserve(TimeType time, size_t size) void -MidiBuffer::silence (nframes_t /*nframes*/, nframes_t /*offset*/) +MidiBuffer::silence (framecnt_t /*nframes*/, framecnt_t /*offset*/) { /* XXX iterate over existing events, find all in range given by offset & nframes, and delete them. @@ -266,162 +296,288 @@ MidiBuffer::silence (nframes_t /*nframes*/, nframes_t /*offset*/) _silent = true; } +bool +MidiBuffer::second_simultaneous_midi_byte_is_first (uint8_t a, uint8_t b) +{ + bool b_first = false; + + /* 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 + Note On + Note Pressure + 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: + break; + case MIDI_CMD_PGM_CHANGE: + case MIDI_CMD_NOTE_OFF: + case MIDI_CMD_NOTE_ON: + case MIDI_CMD_NOTE_PRESSURE: + case MIDI_CMD_CHANNEL_PRESSURE: + case MIDI_CMD_BENDER: + b_first = true; + } + break; + + case MIDI_CMD_NOTE_OFF: + switch (a & 0xf0) { + case MIDI_CMD_CONTROL: + case MIDI_CMD_PGM_CHANGE: + break; + case MIDI_CMD_NOTE_OFF: + case MIDI_CMD_NOTE_ON: + case MIDI_CMD_NOTE_PRESSURE: + case MIDI_CMD_CHANNEL_PRESSURE: + case MIDI_CMD_BENDER: + b_first = true; + } + break; + + case MIDI_CMD_NOTE_ON: + switch (a & 0xf0) { + case MIDI_CMD_CONTROL: + case MIDI_CMD_PGM_CHANGE: + case MIDI_CMD_NOTE_OFF: + break; + case MIDI_CMD_NOTE_ON: + case MIDI_CMD_NOTE_PRESSURE: + case MIDI_CMD_CHANNEL_PRESSURE: + case MIDI_CMD_BENDER: + b_first = true; + } + break; + case MIDI_CMD_NOTE_PRESSURE: + switch (a & 0xf0) { + case MIDI_CMD_CONTROL: + case MIDI_CMD_PGM_CHANGE: + case MIDI_CMD_NOTE_OFF: + case MIDI_CMD_NOTE_ON: + break; + case MIDI_CMD_NOTE_PRESSURE: + case MIDI_CMD_CHANNEL_PRESSURE: + case MIDI_CMD_BENDER: + b_first = true; + } + break; + + case MIDI_CMD_CHANNEL_PRESSURE: + switch (a & 0xf0) { + case MIDI_CMD_CONTROL: + case MIDI_CMD_PGM_CHANGE: + case MIDI_CMD_NOTE_OFF: + case MIDI_CMD_NOTE_ON: + case MIDI_CMD_NOTE_PRESSURE: + break; + case MIDI_CMD_CHANNEL_PRESSURE: + case MIDI_CMD_BENDER: + b_first = true; + } + break; + case MIDI_CMD_BENDER: + switch (a & 0xf0) { + case MIDI_CMD_CONTROL: + case MIDI_CMD_PGM_CHANGE: + case MIDI_CMD_NOTE_OFF: + case MIDI_CMD_NOTE_ON: + case MIDI_CMD_NOTE_PRESSURE: + case MIDI_CMD_CHANNEL_PRESSURE: + break; + case MIDI_CMD_BENDER: + b_first = true; + } + break; + } + } + + return b_first; +} + /** Merge \a other into this buffer. Realtime safe. */ bool -MidiBuffer::merge_in_place(const MidiBuffer &other) +MidiBuffer::merge_in_place (const MidiBuffer &other) { + if (other.size() && size()) { + DEBUG_TRACE (DEBUG::MidiIO, string_compose ("merge in place, sizes %1/%2\n", size(), other.size())); + } + if (other.size() == 0) { return true; } - if (_size == 0) { - copy(other); + if (size() == 0) { + copy (other); return true; } - if (_size + other.size() > _capacity) { - cerr << "MidiBuffer::merge failed (no space)" << endl; + if (size() + other.size() > _capacity) { 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()) { - size_t sz = 0; - ssize_t src = -1; + size_t bytes_to_merge; + ssize_t merge_offset; /* gather up total size of events that are earlier than the event referenced by "us" */ - while (them != other.end() && (*them).time() <= (*us).time()) { - if (src == -1) { - src = them.offset; + merge_offset = -1; + bytes_to_merge = 0; + + while (them != other.end() && (*them).time() < (*us).time()) { + if (merge_offset == -1) { + merge_offset = them.offset; } - sz += sizeof (TimeType) + (*them).size(); + bytes_to_merge += sizeof (TimeType) + (*them).size(); ++them; } -#if 0 - if (us != end()) - cerr << "us @ " << (*us).time() << endl; - if (them != other.end()) - cerr << "them @ " << (*them).time() << endl; -#endif - - if (sz) { - assert(src >= 0); + /* "them" now points to either: + * + * 1) an event that has the same or later timestamp than the + * event pointed to by "us" + * + * OR + * + * 2) the end of the "other" buffer + * + * 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". + */ + + if (bytes_to_merge) { + assert(merge_offset >= 0); /* move existing */ - memmove (_data + us.offset + sz, _data + us.offset, _size - us.offset); + memmove (_data + us.offset + bytes_to_merge, _data + us.offset, _size - us.offset); + /* increase _size */ + _size += bytes_to_merge; + assert (_size <= _capacity); + /* insert new stuff */ + 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 */ + + if (them == other.end()) { + break; + } + + /* if we have two messages messages with the same timestamp. we + * must order them correctly. + */ + + if ((*us).time() == (*them).time()) { + + 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 + */ + + memmove (_data + us.offset + bytes_to_merge, _data + us.offset, _size - us.offset); /* increase _size */ - _size += sz; + _size += bytes_to_merge; assert(_size <= _capacity); /* insert new stuff */ - memcpy (_data + us.offset, other._data + src, sz); + memcpy (_data + us.offset, other._data + them.offset, bytes_to_merge); /* update iterator to our own events. this is a miserable hack */ - us.offset += sz; + us.offset += bytes_to_merge; + /* 'us' is now an iterator to the event right after the + new ones that we merged + */ + 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 + */ + + if (us != end()) { + ++us; + } + } + + /* we merged one event from the other buffer, so + * advance the iterator there. + */ + + ++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()) { + while (us != end() && (*us).time() <= (*them).time()) { ++us; } } - 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; -} + /* check to see if we reached the end of this buffer while + * looking for the insertion point. + */ -/** Clear, and merge \a a and \a b into this buffer. - * - * \return true if complete merge was successful - */ -bool -MidiBuffer::merge(const MidiBuffer& a, const MidiBuffer& b) -{ - _size = 0; - - if (this == &a) { - return merge_in_place(b); - } else if (this == &b) { - return merge_in_place(a); - } + if (us == end()) { - const_iterator ai = a.begin(); - const_iterator bi = b.begin(); + /* just append the rest of other and we're done*/ - 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; + memcpy (_data + us.offset, other._data + them.offset, other._size - them.offset); + _size += other._size - them.offset; + assert(_size <= _capacity); + break; } } - while (ai != a.end()) { - memcpy(_data + _size, (*ai).buffer(), (*ai).size()); - _size += (*ai).size(); - ++ai; - } - - while (bi != b.end()) { - memcpy(_data + _size, (*bi).buffer(), (*bi).size()); - _size += (*bi).size(); - ++bi; - } - return true; }