[pulseview.git] / pv / data / decoderstack.cpp

/*
 * This file is part of the PulseView project.
 *
 * Copyright (C) 2012 Joel Holdsworth <joel@airwebreathe.org.uk>
 *
 * 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., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
 */

#include <libsigrokdecode/libsigrokdecode.h>

#include <boost/foreach.hpp>
#include <boost/thread/thread.hpp>

#include <stdexcept>

#include <QDebug>

#include "decoderstack.h"

#include <pv/data/logic.h>
#include <pv/data/logicsnapshot.h>
#include <pv/data/decode/decoder.h>
#include <pv/data/decode/annotation.h>
#include <pv/sigsession.h>
#include <pv/view/logicsignal.h>

using boost::lock_guard;
using boost::mutex;
using boost::optional;
using boost::shared_ptr;
using boost::unique_lock;
using std::deque;
using std::make_pair;
using std::max;
using std::min;
using std::list;
using std::map;
using std::pair;
using std::vector;

using namespace pv::data::decode;

namespace pv {
namespace data {

const double DecoderStack::DecodeMargin = 1.0;
const double DecoderStack::DecodeThreshold = 0.2;
const int64_t DecoderStack::DecodeChunkLength = 4096;

mutex DecoderStack::_global_decode_mutex;

DecoderStack::DecoderStack(pv::SigSession &session,
	const srd_decoder *const dec) :
	_session(session),
	_sample_count(0),
	_frame_complete(false),
	_samples_decoded(0)
{
	connect(&_session, SIGNAL(frame_began()),
		this, SLOT(on_new_frame()));
	connect(&_session, SIGNAL(data_received()),
		this, SLOT(on_data_received()));
	connect(&_session, SIGNAL(frame_ended()),
		this, SLOT(on_frame_ended()));

	_stack.push_back(shared_ptr<decode::Decoder>(
		new decode::Decoder(dec)));
}

DecoderStack::~DecoderStack()
{
	if (_decode_thread.joinable()) {
		_decode_thread.interrupt();
		_decode_thread.join();
	}
}

const std::list< boost::shared_ptr<decode::Decoder> >&
DecoderStack::stack() const
{
	return _stack;
}

void DecoderStack::push(boost::shared_ptr<decode::Decoder> decoder)
{
	assert(decoder);
	_stack.push_back(decoder);
}

void DecoderStack::remove(int index)
{
	assert(index >= 0);
	assert(index < (int)_stack.size());

	// Find the decoder in the stack
	list< shared_ptr<Decoder> >::iterator iter = _stack.begin();
	for(int i = 0; i < index; i++, iter++)
		assert(iter != _stack.end());

	// Delete the element
	_stack.erase(iter);
}

int64_t DecoderStack::samples_decoded() const
{
	lock_guard<mutex> decode_lock(_output_mutex);
	return _samples_decoded;
}

std::vector<Row> DecoderStack::get_visible_rows() const
{
	lock_guard<mutex> lock(_output_mutex);

	vector<Row> rows;

	BOOST_FOREACH (const shared_ptr<decode::Decoder> &dec, _stack)
	{
		assert(dec);
		if (!dec->shown())
			continue;

		const srd_decoder *const decc = dec->decoder();
		assert(dec->decoder());

		// Add a row for the decoder if it doesn't have a row list
		if (!decc->annotation_rows)
			rows.push_back(Row(decc));

		// Add the decoder rows
		for (const GSList *l = decc->annotation_rows; l; l = l->next)
		{
			const srd_decoder_annotation_row *const ann_row =
				(srd_decoder_annotation_row *)l->data;
			assert(ann_row);
			rows.push_back(Row(decc, ann_row));
		}
	}

	return rows;
}

void DecoderStack::get_annotation_subset(
	std::vector<pv::data::decode::Annotation> &dest,
	const Row &row, uint64_t start_sample,
	uint64_t end_sample) const
{
	lock_guard<mutex> lock(_output_mutex);

	std::map<const Row, decode::RowData>::const_iterator iter =
		_rows.find(row);
	if (iter != _rows.end())
		(*iter).second.get_annotation_subset(dest,
			start_sample, end_sample);
}

QString DecoderStack::error_message()
{
	lock_guard<mutex> lock(_output_mutex);
	return _error_message;
}

void DecoderStack::clear()
{
	_sample_count = 0;
	_frame_complete = false;
	_samples_decoded = 0;
	_error_message = QString();
	_rows.clear();
	_class_rows.clear();
}

void DecoderStack::begin_decode()
{
	shared_ptr<pv::view::LogicSignal> logic_signal;
	shared_ptr<pv::data::Logic> data;

	if (_decode_thread.joinable()) {
		_decode_thread.interrupt();
		_decode_thread.join();
	}

	clear();

	// Add classes
	BOOST_FOREACH (const shared_ptr<decode::Decoder> &dec, _stack)
	{
		assert(dec);
		const srd_decoder *const decc = dec->decoder();
		assert(dec->decoder());

		// Add a row for the decoder if it doesn't have a row list
		if (!decc->annotation_rows)
			_rows[Row(decc)] = decode::RowData();

		// Add the decoder rows
		for (const GSList *l = decc->annotation_rows; l; l = l->next)
		{
			const srd_decoder_annotation_row *const ann_row =
				(srd_decoder_annotation_row *)l->data;
			assert(ann_row);

			const Row row(decc, ann_row);

			// Add a new empty row data object
			_rows[row] = decode::RowData();

			// Map out all the classes
			for (const GSList *ll = ann_row->ann_classes;
				ll; ll = ll->next)
				_class_rows[make_pair(decc,
					GPOINTER_TO_INT(ll->data))] = row;
		}
	}

	// We get the logic data of the first probe in the list.
	// This works because we are currently assuming all
	// LogicSignals have the same data/snapshot
	BOOST_FOREACH (const shared_ptr<decode::Decoder> &dec, _stack)
		if (dec && !dec->probes().empty() &&
			((logic_signal = (*dec->probes().begin()).second)) &&
			((data = logic_signal->logic_data())))
			break;

	if (!data)
		return;

	// Check we have a snapshot of data
	const deque< shared_ptr<pv::data::LogicSnapshot> > &snapshots =
		data->get_snapshots();
	if (snapshots.empty())
		return;
	_snapshot = snapshots.front();

	// Get the samplerate and start time
	_start_time = data->get_start_time();
	_samplerate = data->samplerate();
	if (_samplerate == 0.0)
		_samplerate = 1.0;

	_decode_thread = boost::thread(&DecoderStack::decode_proc, this,
		data);
}

uint64_t DecoderStack::get_max_sample_count() const
{
	uint64_t max_sample_count = 0;

	for (map<const Row, RowData>::const_iterator i = _rows.begin();
		i != _rows.end(); i++)
		max_sample_count = max(max_sample_count,
			(*i).second.get_max_sample());

	return max_sample_count;
}

optional<int64_t> DecoderStack::wait_for_data() const
{
	unique_lock<mutex> input_lock(_input_mutex);
	while(!boost::this_thread::interruption_requested() &&
		!_frame_complete && _samples_decoded >= _sample_count)
		_input_cond.wait(input_lock);
	return boost::make_optional(
		!boost::this_thread::interruption_requested() &&
		(_samples_decoded < _sample_count || !_frame_complete),
		_sample_count);
}

void DecoderStack::decode_data(
	const int64_t sample_count, const unsigned int unit_size,
	srd_session *const session)
{
	uint8_t chunk[DecodeChunkLength];

	const unsigned int chunk_sample_count =
		DecodeChunkLength / _snapshot->unit_size();

	for (int64_t i = 0;
		!boost::this_thread::interruption_requested() &&
			i < sample_count;
		i += chunk_sample_count)
	{
		lock_guard<mutex> decode_lock(_global_decode_mutex);

		const int64_t chunk_end = min(
			i + chunk_sample_count, sample_count);
		_snapshot->get_samples(chunk, i, chunk_end);

		if (srd_session_send(session, i, i + sample_count, chunk,
				(chunk_end - i) * unit_size) != SRD_OK) {
			_error_message = tr("Decoder reported an error");
			break;
		}

		{
			lock_guard<mutex> lock(_output_mutex);
			_samples_decoded = chunk_end;
		}
	}

	new_decode_data();
}

void DecoderStack::decode_proc(shared_ptr<data::Logic> data)
{
	optional<int64_t> sample_count;
	srd_session *session;
	srd_decoder_inst *prev_di = NULL;

	assert(data);
	assert(_snapshot);

	// Check that all decoders have the required probes
	BOOST_FOREACH(const shared_ptr<decode::Decoder> &dec, _stack)
		if (!dec->have_required_probes())
			return;

	// Create the session
	srd_session_new(&session);
	assert(session);

	// Create the decoders
	const unsigned int unit_size = _snapshot->unit_size();

	BOOST_FOREACH(const shared_ptr<decode::Decoder> &dec, _stack)
	{
		srd_decoder_inst *const di = dec->create_decoder_inst(session, unit_size);

		if (!di)
		{
			_error_message = tr("Failed to create decoder instance");
			srd_session_destroy(session);
			return;
		}

		if (prev_di)
			srd_inst_stack (session, prev_di, di);

		prev_di = di;
	}

	// Get the intial sample count
	{
		unique_lock<mutex> input_lock(_input_mutex);
		sample_count = _sample_count = _snapshot->get_sample_count();
	}

	// Start the session
	srd_session_metadata_set(session, SRD_CONF_SAMPLERATE,
		g_variant_new_uint64((uint64_t)_samplerate));

	srd_pd_output_callback_add(session, SRD_OUTPUT_ANN,
		DecoderStack::annotation_callback, this);

	srd_session_start(session);

	do {
		decode_data(*sample_count, unit_size, session);
	} while(_error_message.isEmpty() && (sample_count = wait_for_data()));

	// Destroy the session
	srd_session_destroy(session);
}

void DecoderStack::annotation_callback(srd_proto_data *pdata, void *decoder)
{
	assert(pdata);
	assert(decoder);

	DecoderStack *const d = (DecoderStack*)decoder;
	assert(d);

	lock_guard<mutex> lock(d->_output_mutex);

	const Annotation a(pdata);

	// Find the row
	assert(pdata->pdo);
	assert(pdata->pdo->di);
	const srd_decoder *const decc = pdata->pdo->di->decoder;
	assert(decc);

	map<const Row, decode::RowData>::iterator row_iter = d->_rows.end();
	
	// Try looking up the sub-row of this class
	const map<pair<const srd_decoder*, int>, Row>::const_iterator r =
		d->_class_rows.find(make_pair(decc, a.format()));
	if (r != d->_class_rows.end())
		row_iter = d->_rows.find((*r).second);
	else
	{
		// Failing that, use the decoder as a key
		row_iter = d->_rows.find(Row(decc));	
	}

	assert(row_iter != d->_rows.end());
	if (row_iter == d->_rows.end()) {
		qDebug() << "Unexpected annotation: decoder = " << decc <<
			", format = " << a.format();
		assert(0);
		return;
	}

	// Add the annotation
	(*row_iter).second.push_annotation(a);
}

void DecoderStack::on_new_frame()
{
	begin_decode();
}

void DecoderStack::on_data_received()
{
	{
		unique_lock<mutex> lock(_input_mutex);
		_sample_count = _snapshot->get_sample_count();
	}
	_input_cond.notify_one();
}

void DecoderStack::on_frame_ended()
{
	{
		unique_lock<mutex> lock(_input_mutex);
		_frame_complete = true;
	}
	_input_cond.notify_one();
}

} // namespace data
} // namespace pv
Commit	Line	Data
119aff65 JH	1	/*
	2	* This file is part of the PulseView project.
	3	*
	4	* Copyright (C) 2012 Joel Holdsworth <joel@airwebreathe.org.uk>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* (at your option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
	19	*/
	20
e332f6d3 JH	21	#include <libsigrokdecode/libsigrokdecode.h>
e332f6d3 JH	22
7491a29f	23	#include <boost/foreach.hpp>
e0fc5810 JH	24	#include <boost/thread/thread.hpp>
e0fc5810 JH	25
e92cd4e4 JH	26	#include <stdexcept>
e92cd4e4 JH	27
b213ef09 JH	28	#include <QDebug>
b213ef09 JH	29
6e89374a	30	#include "decoderstack.h"
119aff65	31
e0fc5810 JH	32	#include <pv/data/logic.h>
e0fc5810 JH	33	#include <pv/data/logicsnapshot.h>
7491a29f	34	#include <pv/data/decode/decoder.h>
06e810f2	35	#include <pv/data/decode/annotation.h>
82f50b10	36	#include <pv/sigsession.h>
e0fc5810	37	#include <pv/view/logicsignal.h>
708c5523	38
819f4c25 JH	39	using boost::lock_guard;
819f4c25 JH	40	using boost::mutex;
f70d8673	41	using boost::optional;
819f4c25	42	using boost::shared_ptr;
f70d8673	43	using boost::unique_lock;
819f4c25	44	using std::deque;
f9101a91 JH	45	using std::make_pair;
f9101a91 JH	46	using std::max;
819f4c25 JH	47	using std::min;
819f4c25 JH	48	using std::list;
f9101a91 JH	49	using std::map;
f9101a91 JH	50	using std::pair;
819f4c25	51	using std::vector;
e332f6d3	52
f9101a91 JH	53	using namespace pv::data::decode;
f9101a91 JH	54
119aff65 JH	55	namespace pv {
	56	namespace data {
	57
6e89374a JH	58	const double DecoderStack::DecodeMargin = 1.0;
	59	const double DecoderStack::DecodeThreshold = 0.2;
	60	const int64_t DecoderStack::DecodeChunkLength = 4096;
e0fc5810	61
6e89374a	62	mutex DecoderStack::_global_decode_mutex;
fe89c961	63
bdc5c3b0 JH	64	DecoderStack::DecoderStack(pv::SigSession &session,
	65	const srd_decoder *const dec) :
	66	_session(session),
f70d8673 JH	67	_sample_count(0),
f70d8673 JH	68	_frame_complete(false),
5dfeb70f	69	_samples_decoded(0)
119aff65	70	{
f70d8673 JH	71	connect(&_session, SIGNAL(frame_began()),
	72	this, SLOT(on_new_frame()));
	73	connect(&_session, SIGNAL(data_received()),
	74	this, SLOT(on_data_received()));
	75	connect(&_session, SIGNAL(frame_ended()),
	76	this, SLOT(on_frame_ended()));
82f50b10	77
7491a29f JH	78	_stack.push_back(shared_ptr<decode::Decoder>(
7491a29f JH	79	new decode::Decoder(dec)));
119aff65 JH	80	}
119aff65 JH	81
6e89374a	82	DecoderStack::~DecoderStack()
640d69ce	83	{
6d483b8b MC	84	if (_decode_thread.joinable()) {
	85	_decode_thread.interrupt();
	86	_decode_thread.join();
	87	}
4e5a4405 JH	88	}
4e5a4405 JH	89
7491a29f JH	90	const std::list< boost::shared_ptr<decode::Decoder> >&
7491a29f JH	91	DecoderStack::stack() const
4e5a4405	92	{
7491a29f	93	return _stack;
4e5a4405 JH	94	}
4e5a4405 JH	95
7491a29f	96	void DecoderStack::push(boost::shared_ptr<decode::Decoder> decoder)
4e5a4405	97	{
7491a29f JH	98	assert(decoder);
7491a29f JH	99	_stack.push_back(decoder);
4e5a4405 JH	100	}
4e5a4405 JH	101
613d097c JH	102	void DecoderStack::remove(int index)
613d097c JH	103	{
613d097c JH	104	assert(index >= 0);
	105	assert(index < (int)_stack.size());
	106
	107	// Find the decoder in the stack
	108	list< shared_ptr<Decoder> >::iterator iter = _stack.begin();
	109	for(int i = 0; i < index; i++, iter++)
	110	assert(iter != _stack.end());
	111
	112	// Delete the element
	113	_stack.erase(iter);
	114	}
	115
5dfeb70f JH	116	int64_t DecoderStack::samples_decoded() const
5dfeb70f JH	117	{
28b9cc08	118	lock_guard<mutex> decode_lock(_output_mutex);
5dfeb70f JH	119	return _samples_decoded;
	120	}
	121
dd048a7e	122	std::vector<Row> DecoderStack::get_visible_rows() const
f9101a91	123	{
28b9cc08	124	lock_guard<mutex> lock(_output_mutex);
f9101a91 JH	125
	126	vector<Row> rows;
	127
	128	BOOST_FOREACH (const shared_ptr<decode::Decoder> &dec, _stack)
	129	{
	130	assert(dec);
dd048a7e JH	131	if (!dec->shown())
	132	continue;
	133
f9101a91 JH	134	const srd_decoder *const decc = dec->decoder();
	135	assert(dec->decoder());
	136
	137	// Add a row for the decoder if it doesn't have a row list
	138	if (!decc->annotation_rows)
	139	rows.push_back(Row(decc));
	140
	141	// Add the decoder rows
	142	for (const GSList *l = decc->annotation_rows; l; l = l->next)
	143	{
	144	const srd_decoder_annotation_row *const ann_row =
	145	(srd_decoder_annotation_row *)l->data;
	146	assert(ann_row);
	147	rows.push_back(Row(decc, ann_row));
	148	}
	149	}
	150
	151	return rows;
	152	}
	153
92421299 JH	154	void DecoderStack::get_annotation_subset(
92421299 JH	155	std::vector<pv::data::decode::Annotation> &dest,
f9101a91 JH	156	const Row &row, uint64_t start_sample,
f9101a91 JH	157	uint64_t end_sample) const
e0fc5810	158	{
28b9cc08	159	lock_guard<mutex> lock(_output_mutex);
92421299	160
f9101a91 JH	161	std::map<const Row, decode::RowData>::const_iterator iter =
	162	_rows.find(row);
	163	if (iter != _rows.end())
	164	(*iter).second.get_annotation_subset(dest,
	165	start_sample, end_sample);
e0fc5810 JH	166	}
e0fc5810 JH	167
6e89374a	168	QString DecoderStack::error_message()
b6b267bb	169	{
28b9cc08	170	lock_guard<mutex> lock(_output_mutex);
b6b267bb JH	171	return _error_message;
	172	}
	173
f9101a91 JH	174	void DecoderStack::clear()
f9101a91 JH	175	{
f70d8673 JH	176	_sample_count = 0;
f70d8673 JH	177	_frame_complete = false;
f9101a91 JH	178	_samples_decoded = 0;
	179	_error_message = QString();
	180	_rows.clear();
	181	_class_rows.clear();
	182	}
	183
6e89374a	184	void DecoderStack::begin_decode()
640d69ce	185	{
7491a29f JH	186	shared_ptr<pv::view::LogicSignal> logic_signal;
	187	shared_ptr<pv::data::Logic> data;
	188
6d483b8b MC	189	if (_decode_thread.joinable()) {
	190	_decode_thread.interrupt();
	191	_decode_thread.join();
	192	}
640d69ce	193
92421299	194	clear();
4e5a4405	195
f9101a91 JH	196	// Add classes
	197	BOOST_FOREACH (const shared_ptr<decode::Decoder> &dec, _stack)
	198	{
	199	assert(dec);
	200	const srd_decoder *const decc = dec->decoder();
	201	assert(dec->decoder());
	202
	203	// Add a row for the decoder if it doesn't have a row list
	204	if (!decc->annotation_rows)
	205	_rows[Row(decc)] = decode::RowData();
	206
	207	// Add the decoder rows
	208	for (const GSList *l = decc->annotation_rows; l; l = l->next)
	209	{
	210	const srd_decoder_annotation_row *const ann_row =
	211	(srd_decoder_annotation_row *)l->data;
	212	assert(ann_row);
	213
	214	const Row row(decc, ann_row);
	215
	216	// Add a new empty row data object
	217	_rows[row] = decode::RowData();
	218
	219	// Map out all the classes
	220	for (const GSList *ll = ann_row->ann_classes;
	221	ll; ll = ll->next)
	222	_class_rows[make_pair(decc,
	223	GPOINTER_TO_INT(ll->data))] = row;
	224	}
	225	}
	226
e0fc5810 JH	227	// We get the logic data of the first probe in the list.
	228	// This works because we are currently assuming all
	229	// LogicSignals have the same data/snapshot
7491a29f JH	230	BOOST_FOREACH (const shared_ptr<decode::Decoder> &dec, _stack)
	231	if (dec && !dec->probes().empty() &&
	232	((logic_signal = (*dec->probes().begin()).second)) &&
7aa09b00	233	((data = logic_signal->logic_data())))
7491a29f JH	234	break;
	235
	236	if (!data)
	237	return;
	238
f70d8673 JH	239	// Check we have a snapshot of data
	240	const deque< shared_ptr<pv::data::LogicSnapshot> > &snapshots =
	241	data->get_snapshots();
	242	if (snapshots.empty())
	243	return;
	244	_snapshot = snapshots.front();
	245
7491a29f JH	246	// Get the samplerate and start time
7491a29f JH	247	_start_time = data->get_start_time();
9d28da5a	248	_samplerate = data->samplerate();
7491a29f JH	249	if (_samplerate == 0.0)
7491a29f JH	250	_samplerate = 1.0;
e0fc5810	251
6e89374a	252	_decode_thread = boost::thread(&DecoderStack::decode_proc, this,
e0fc5810	253	data);
640d69ce JH	254	}
640d69ce JH	255
a007f5ad JH	256	uint64_t DecoderStack::get_max_sample_count() const
a007f5ad JH	257	{
f9101a91 JH	258	uint64_t max_sample_count = 0;
	259
	260	for (map<const Row, RowData>::const_iterator i = _rows.begin();
	261	i != _rows.end(); i++)
	262	max_sample_count = max(max_sample_count,
	263	(*i).second.get_max_sample());
	264
	265	return max_sample_count;
a007f5ad JH	266	}
a007f5ad JH	267
f70d8673 JH	268	optional<int64_t> DecoderStack::wait_for_data() const
	269	{
	270	unique_lock<mutex> input_lock(_input_mutex);
	271	while(!boost::this_thread::interruption_requested() &&
	272	!_frame_complete && _samples_decoded >= _sample_count)
	273	_input_cond.wait(input_lock);
	274	return boost::make_optional(
	275	!boost::this_thread::interruption_requested() &&
	276	(_samples_decoded < _sample_count \|\| !_frame_complete),
	277	_sample_count);
	278	}
	279
f67d9e9b	280	void DecoderStack::decode_data(
f70d8673	281	const int64_t sample_count, const unsigned int unit_size,
f67d9e9b JH	282	srd_session *const session)
	283	{
	284	uint8_t chunk[DecodeChunkLength];
	285
f67d9e9b	286	const unsigned int chunk_sample_count =
f70d8673	287	DecodeChunkLength / _snapshot->unit_size();
f67d9e9b JH	288
	289	for (int64_t i = 0;
	290	!boost::this_thread::interruption_requested() &&
	291	i < sample_count;
	292	i += chunk_sample_count)
	293	{
	294	lock_guard<mutex> decode_lock(_global_decode_mutex);
	295
	296	const int64_t chunk_end = min(
	297	i + chunk_sample_count, sample_count);
f70d8673	298	_snapshot->get_samples(chunk, i, chunk_end);
f67d9e9b JH	299
	300	if (srd_session_send(session, i, i + sample_count, chunk,
	301	(chunk_end - i) * unit_size) != SRD_OK) {
	302	_error_message = tr("Decoder reported an error");
	303	break;
	304	}
	305
	306	{
28b9cc08	307	lock_guard<mutex> lock(_output_mutex);
f67d9e9b JH	308	_samples_decoded = chunk_end;
	309	}
	310	}
	311
1c5fb759	312	new_decode_data();
f67d9e9b JH	313	}
f67d9e9b JH	314
6e89374a	315	void DecoderStack::decode_proc(shared_ptr<data::Logic> data)
119aff65	316	{
f70d8673	317	optional<int64_t> sample_count;
b6b267bb	318	srd_session *session;
7491a29f	319	srd_decoder_inst *prev_di = NULL;
e0fc5810 JH	320
e0fc5810 JH	321	assert(data);
f70d8673	322	assert(_snapshot);
e0fc5810	323
a2d4b551 JH	324	// Check that all decoders have the required probes
	325	BOOST_FOREACH(const shared_ptr<decode::Decoder> &dec, _stack)
	326	if (!dec->have_required_probes())
	327	return;
	328
b6b267bb JH	329	// Create the session
	330	srd_session_new(&session);
	331	assert(session);
e0fc5810	332
7491a29f	333	// Create the decoders
f70d8673	334	const unsigned int unit_size = _snapshot->unit_size();
f67d9e9b	335
7491a29f JH	336	BOOST_FOREACH(const shared_ptr<decode::Decoder> &dec, _stack)
7491a29f JH	337	{
13a3528c	338	srd_decoder_inst *const di = dec->create_decoder_inst(session, unit_size);
e0fc5810	339
7491a29f JH	340	if (!di)
7491a29f JH	341	{
8a290daf	342	_error_message = tr("Failed to create decoder instance");
7491a29f JH	343	srd_session_destroy(session);
	344	return;
	345	}
b6b267bb	346
7491a29f JH	347	if (prev_di)
7491a29f JH	348	srd_inst_stack (session, prev_di, di);
b6b267bb	349
7491a29f	350	prev_di = di;
b6b267bb JH	351	}
b6b267bb JH	352
f70d8673 JH	353	// Get the intial sample count
	354	{
	355	unique_lock<mutex> input_lock(_input_mutex);
	356	sample_count = _sample_count = _snapshot->get_sample_count();
	357	}
	358
b6b267bb	359	// Start the session
7491a29f JH	360	srd_session_metadata_set(session, SRD_CONF_SAMPLERATE,
	361	g_variant_new_uint64((uint64_t)_samplerate));
	362
	363	srd_pd_output_callback_add(session, SRD_OUTPUT_ANN,
	364	DecoderStack::annotation_callback, this);
	365
b6b267bb JH	366	srd_session_start(session);
b6b267bb JH	367
f70d8673 JH	368	do {
	369	decode_data(*sample_count, unit_size, session);
	370	} while(_error_message.isEmpty() && (sample_count = wait_for_data()));
b6b267bb JH	371
	372	// Destroy the session
	373	srd_session_destroy(session);
e0fc5810 JH	374	}
e0fc5810 JH	375
6e89374a	376	void DecoderStack::annotation_callback(srd_proto_data pdata, void decoder)
e0fc5810	377	{
e0fc5810 JH	378	assert(pdata);
	379	assert(decoder);
	380
6e89374a	381	DecoderStack const d = (DecoderStack)decoder;
f9101a91	382	assert(d);
e0fc5810	383
28b9cc08	384	lock_guard<mutex> lock(d->_output_mutex);
6d8b0562	385
f9101a91 JH	386	const Annotation a(pdata);
	387
	388	// Find the row
	389	assert(pdata->pdo);
	390	assert(pdata->pdo->di);
	391	const srd_decoder *const decc = pdata->pdo->di->decoder;
	392	assert(decc);
	393
	394	map<const Row, decode::RowData>::iterator row_iter = d->_rows.end();
	395
	396	// Try looking up the sub-row of this class
	397	const map<pair<const srd_decoder*, int>, Row>::const_iterator r =
	398	d->_class_rows.find(make_pair(decc, a.format()));
	399	if (r != d->_class_rows.end())
	400	row_iter = d->_rows.find((*r).second);
	401	else
6d8b0562	402	{
f9101a91 JH	403	// Failing that, use the decoder as a key
f9101a91 JH	404	row_iter = d->_rows.find(Row(decc));
6d8b0562 UH	405	}
6d8b0562 UH	406
f9101a91 JH	407	assert(row_iter != d->_rows.end());
	408	if (row_iter == d->_rows.end()) {
	409	qDebug() << "Unexpected annotation: decoder = " << decc <<
	410	", format = " << a.format();
	411	assert(0);
	412	return;
	413	}
9cef9567	414
f9101a91 JH	415	// Add the annotation
f9101a91 JH	416	(*row_iter).second.push_annotation(a);
119aff65 JH	417	}
119aff65 JH	418
82f50b10 JH	419	void DecoderStack::on_new_frame()
	420	{
	421	begin_decode();
	422	}
	423
f70d8673 JH	424	void DecoderStack::on_data_received()
	425	{
	426	{
	427	unique_lock<mutex> lock(_input_mutex);
	428	_sample_count = _snapshot->get_sample_count();
	429	}
	430	_input_cond.notify_one();
	431	}
	432
	433	void DecoderStack::on_frame_ended()
	434	{
	435	{
	436	unique_lock<mutex> lock(_input_mutex);
	437	_frame_complete = true;
	438	}
	439	_input_cond.notify_one();
	440	}
	441
119aff65 JH	442	} // namespace data
119aff65 JH	443	} // namespace pv