Feed analog data into separate deinterleaved analog data objects per channel

[pulseview.git] / pv / sigsession.cpp

/*
 * This file is part of the PulseView project.
 *
 * Copyright (C) 2012-14 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
 */

#ifdef ENABLE_DECODE
#include <libsigrokdecode/libsigrokdecode.h>
#endif

#include "sigsession.h"

#include "devicemanager.h"

#include "data/analog.h"
#include "data/analogsnapshot.h"
#include "data/decoderstack.h"
#include "data/logic.h"
#include "data/logicsnapshot.h"
#include "data/decode/decoder.h"

#include "view/analogsignal.h"
#include "view/decodetrace.h"
#include "view/logicsignal.h"

#include <assert.h>

#include <stdexcept>

#include <boost/foreach.hpp>

#include <sys/stat.h>

#include <QDebug>

using boost::dynamic_pointer_cast;
using boost::function;
using boost::lock_guard;
using boost::mutex;
using boost::shared_ptr;
using std::map;
using std::set;
using std::string;
using std::vector;

namespace pv {

// TODO: This should not be necessary
SigSession* SigSession::_session = NULL;

SigSession::SigSession(DeviceManager &device_manager) :
	_device_manager(device_manager),
	_sdi(NULL),
	_capture_state(Stopped)
{
	// TODO: This should not be necessary
	_session = this;
}

SigSession::~SigSession()
{
	stop_capture();

	_sampling_thread.join();

	if (_sdi)
		_device_manager.release_device(_sdi);
	_sdi = NULL;

	// TODO: This should not be necessary
	_session = NULL;
}

struct sr_dev_inst* SigSession::get_device() const
{
	return _sdi;
}

void SigSession::set_device(struct sr_dev_inst *sdi)
{
	// Ensure we are not capturing before setting the device
	stop_capture();

	if (_sdi)
		_device_manager.release_device(_sdi);
	if (sdi)
		_device_manager.use_device(sdi, this);
	_sdi = sdi;
	update_signals(sdi);
}

void SigSession::release_device(struct sr_dev_inst *sdi)
{
	(void)sdi;

	assert(_capture_state == Stopped);
	_sdi = NULL;
	update_signals(NULL);
}

void SigSession::load_file(const string &name,
	function<void (const QString)> error_handler)
{
	stop_capture();

	if (sr_session_load(name.c_str()) == SR_OK) {
		GSList *devlist = NULL;
		sr_session_dev_list(&devlist);

		if (!devlist || !devlist->data ||
			sr_session_start() != SR_OK) {
			error_handler(tr("Failed to start session."));
			return;
		}

		sr_dev_inst *const sdi = (sr_dev_inst*)devlist->data;
		g_slist_free(devlist);

		_decode_traces.clear();
		update_signals(sdi);
		read_sample_rate(sdi);

		_sampling_thread = boost::thread(
			&SigSession::load_session_thread_proc, this,
			error_handler);

	} else {
		sr_input *in = NULL;

		if (!(in = load_input_file_format(name.c_str(),
			error_handler)))
			return;

		_decode_traces.clear();
		update_signals(in->sdi);
		read_sample_rate(in->sdi);

		_sampling_thread = boost::thread(
			&SigSession::load_input_thread_proc, this,
			name, in, error_handler);
	}
}

SigSession::capture_state SigSession::get_capture_state() const
{
	lock_guard<mutex> lock(_sampling_mutex);
	return _capture_state;
}

void SigSession::start_capture(uint64_t record_length,
	function<void (const QString)> error_handler)
{
	stop_capture();

	// Check that a device instance has been selected.
	if (!_sdi) {
		qDebug() << "No device selected";
		return;
	}

	// Check that at least one probe is enabled
	const GSList *l;
	for (l = _sdi->probes; l; l = l->next) {
		sr_probe *const probe = (sr_probe*)l->data;
		assert(probe);
		if (probe->enabled)
			break;
	}

	if (!l) {
		error_handler(tr("No probes enabled."));
		return;
	}

	// Begin the session
	_sampling_thread = boost::thread(
		&SigSession::sample_thread_proc, this, _sdi,
		record_length, error_handler);
}

void SigSession::stop_capture()
{
	if (get_capture_state() == Stopped)
		return;

	sr_session_stop();

	// Check that sampling stopped
	_sampling_thread.join();
}

set< shared_ptr<data::SignalData> > SigSession::get_data() const
{
	lock_guard<mutex> lock(_signals_mutex);
	set< shared_ptr<data::SignalData> > data;
	BOOST_FOREACH(const shared_ptr<view::Signal> sig, _signals) {
		assert(sig);
		data.insert(sig->data());
	}

	return data;
}

vector< shared_ptr<view::Signal> > SigSession::get_signals() const
{
	lock_guard<mutex> lock(_signals_mutex);
	return _signals;
}

#ifdef ENABLE_DECODE
bool SigSession::add_decoder(srd_decoder *const dec)
{
	map<const srd_probe*, shared_ptr<view::LogicSignal> > probes;
	shared_ptr<data::DecoderStack> decoder_stack;

	try
	{
		lock_guard<mutex> lock(_signals_mutex);

		// Create the decoder
		decoder_stack = shared_ptr<data::DecoderStack>(
			new data::DecoderStack(dec));

		// Auto select the initial probes
		for(const GSList *i = dec->probes; i; i = i->next)
		{
			const srd_probe *const probe = (const srd_probe*)i->data;
			BOOST_FOREACH(shared_ptr<view::Signal> s, _signals)
			{
				shared_ptr<view::LogicSignal> l =
					dynamic_pointer_cast<view::LogicSignal>(s);
				if (l && QString::fromUtf8(probe->name).
					toLower().contains(
					l->get_name().toLower()))
					probes[probe] = l;
			}
		}

		assert(decoder_stack);
		assert(!decoder_stack->stack().empty());
		assert(decoder_stack->stack().front());
		decoder_stack->stack().front()->set_probes(probes);

		// Create the decode signal
		shared_ptr<view::DecodeTrace> d(
			new view::DecodeTrace(*this, decoder_stack,
				_decode_traces.size()));
		_decode_traces.push_back(d);
	}
	catch(std::runtime_error e)
	{
		return false;
	}

	signals_changed();

	// Do an initial decode
	decoder_stack->begin_decode();

	return true;
}

vector< shared_ptr<view::DecodeTrace> > SigSession::get_decode_signals() const
{
	lock_guard<mutex> lock(_signals_mutex);
	return _decode_traces;
}

void SigSession::remove_decode_signal(view::DecodeTrace *signal)
{
	for (vector< shared_ptr<view::DecodeTrace> >::iterator i =
		_decode_traces.begin();
		i != _decode_traces.end();
		i++)
		if ((*i).get() == signal)
		{
			_decode_traces.erase(i);
			signals_changed();
			return;
		}
}
#endif

void SigSession::set_capture_state(capture_state state)
{
	lock_guard<mutex> lock(_sampling_mutex);
	const bool changed = _capture_state != state;
	_capture_state = state;
	if(changed)
		capture_state_changed(state);
}

/**
 * Attempts to autodetect the format. Failing that
 * @param filename The filename of the input file.
 * @return A pointer to the 'struct sr_input_format' that should be used,
 *         or NULL if no input format was selected or auto-detected.
 */
sr_input_format* SigSession::determine_input_file_format(
	const string &filename)
{
	int i;

	/* If there are no input formats, return NULL right away. */
	sr_input_format *const *const inputs = sr_input_list();
	if (!inputs) {
		g_critical("No supported input formats available.");
		return NULL;
	}

	/* Otherwise, try to find an input module that can handle this file. */
	for (i = 0; inputs[i]; i++) {
		if (inputs[i]->format_match(filename.c_str()))
			break;
	}

	/* Return NULL if no input module wanted to touch this. */
	if (!inputs[i]) {
		g_critical("Error: no matching input module found.");
		return NULL;
	}

	return inputs[i];
}

sr_input* SigSession::load_input_file_format(const string &filename,
	function<void (const QString)> error_handler,
	sr_input_format *format)
{
	struct stat st;
	sr_input *in;

	if (!format && !(format =
		determine_input_file_format(filename.c_str()))) {
		/* The exact cause was already logged. */
		return NULL;
	}

	if (stat(filename.c_str(), &st) == -1) {
		error_handler(tr("Failed to load file"));
		return NULL;
	}

	/* Initialize the input module. */
	if (!(in = new sr_input)) {
		qDebug("Failed to allocate input module.\n");
		return NULL;
	}

	in->format = format;
	in->param = NULL;
	if (in->format->init &&
		in->format->init(in, filename.c_str()) != SR_OK) {
		qDebug("Input format init failed.\n");
		return NULL;
	}

	sr_session_new();

	if (sr_session_dev_add(in->sdi) != SR_OK) {
		qDebug("Failed to use device.\n");
		sr_session_destroy();
		return NULL;
	}

	return in;
}

void SigSession::update_signals(const sr_dev_inst *const sdi)
{
	assert(_capture_state == Stopped);

	unsigned int logic_probe_count = 0;

	// Clear the decode traces
	_decode_traces.clear();

	// Detect what data types we will receive
	if(sdi) {
		for (const GSList *l = sdi->probes; l; l = l->next) {
			const sr_probe *const probe = (const sr_probe *)l->data;
			if (!probe->enabled)
				continue;

			switch(probe->type) {
			case SR_PROBE_LOGIC:
				logic_probe_count++;
				break;
			}
		}
	}

	// Create data containers for the logic data snapshots
	{
		lock_guard<mutex> data_lock(_data_mutex);

		_logic_data.reset();
		if (logic_probe_count != 0) {
			_logic_data.reset(new data::Logic(
				logic_probe_count));
			assert(_logic_data);
		}
	}

	// Make the Signals list
	do {
		lock_guard<mutex> lock(_signals_mutex);

		_signals.clear();

		if(!sdi)
			break;

		for (const GSList *l = sdi->probes; l; l = l->next) {
			shared_ptr<view::Signal> signal;
			sr_probe *const probe =	(sr_probe *)l->data;
			assert(probe);

			switch(probe->type) {
			case SR_PROBE_LOGIC:
				signal = shared_ptr<view::Signal>(
					new view::LogicSignal(*this, probe,
						_logic_data));
				break;

			case SR_PROBE_ANALOG:
			{
				shared_ptr<data::Analog> data(
					new data::Analog());
				signal = shared_ptr<view::Signal>(
					new view::AnalogSignal(*this, probe,
						data));
				break;
			}

			default:
				assert(0);
				break;
			}

			assert(signal);
			_signals.push_back(signal);
		}

	} while(0);

	signals_changed();
}

bool SigSession::is_trigger_enabled() const
{
	assert(_sdi);
	for (const GSList *l = _sdi->probes; l; l = l->next) {
		const sr_probe *const p = (const sr_probe *)l->data;
		assert(p);
		if (p->trigger && p->trigger[0] != '\0')
			return true;
	}

	return false;
}

shared_ptr<view::Signal> SigSession::signal_from_probe(
	const sr_probe *probe) const
{
	lock_guard<mutex> lock(_signals_mutex);
	BOOST_FOREACH(shared_ptr<view::Signal> sig, _signals) {
		assert(sig);
		if (sig->probe() == probe)
			return sig;
	}
	return shared_ptr<view::Signal>();
}

void SigSession::read_sample_rate(const sr_dev_inst *const sdi)
{
	GVariant *gvar;
	uint64_t sample_rate = 0;

	// Read out the sample rate
	if(sdi->driver)
	{
		const int ret = sr_config_get(sdi->driver, sdi, NULL,
			SR_CONF_SAMPLERATE, &gvar);
		if (ret != SR_OK) {
			qDebug("Failed to get samplerate\n");
			return;
		}

		sample_rate = g_variant_get_uint64(gvar);
		g_variant_unref(gvar);
	}

	// Set the sample rate of all data
	const set< shared_ptr<data::SignalData> > data_set = get_data();
	BOOST_FOREACH(shared_ptr<data::SignalData> data, data_set) {
		assert(data);
		data->set_samplerate(sample_rate);
	}
}

void SigSession::load_session_thread_proc(
	function<void (const QString)> error_handler)
{
	(void)error_handler;

	sr_session_datafeed_callback_add(data_feed_in_proc, NULL);

	set_capture_state(Running);

	sr_session_run();

	sr_session_destroy();
	set_capture_state(Stopped);

	// Confirm that SR_DF_END was received
	assert(!_cur_logic_snapshot);
	assert(_cur_analog_snapshots.empty());
}

void SigSession::load_input_thread_proc(const string name,
	sr_input *in, function<void (const QString)> error_handler)
{
	(void)error_handler;

	assert(in);
	assert(in->format);

	sr_session_datafeed_callback_add(data_feed_in_proc, NULL);

	set_capture_state(Running);

	in->format->loadfile(in, name.c_str());

	sr_session_destroy();
	set_capture_state(Stopped);

	// Confirm that SR_DF_END was received
	assert(!_cur_logic_snapshot);
	assert(_cur_analog_snapshots.empty());

	delete in;
}

void SigSession::sample_thread_proc(struct sr_dev_inst *sdi,
	uint64_t record_length,
	function<void (const QString)> error_handler)
{
	assert(sdi);
	assert(error_handler);

	sr_session_new();
	sr_session_datafeed_callback_add(data_feed_in_proc, NULL);

	if (sr_session_dev_add(sdi) != SR_OK) {
		error_handler(tr("Failed to use device."));
		sr_session_destroy();
		return;
	}

	// Set the sample limit
	if (sr_config_set(sdi, NULL, SR_CONF_LIMIT_SAMPLES,
		g_variant_new_uint64(record_length)) != SR_OK) {
		error_handler(tr("Failed to configure "
			"time-based sample limit."));
		sr_session_destroy();
		return;
	}

	if (sr_session_start() != SR_OK) {
		error_handler(tr("Failed to start session."));
		return;
	}

	set_capture_state(is_trigger_enabled() ? AwaitingTrigger : Running);

	sr_session_run();
	sr_session_destroy();

	set_capture_state(Stopped);

	// Confirm that SR_DF_END was received
	if (_cur_logic_snapshot)
	{
		qDebug("SR_DF_END was not received.");
		assert(0);
	}
}

void SigSession::feed_in_header(const sr_dev_inst *sdi)
{
	read_sample_rate(sdi);
}

void SigSession::feed_in_meta(const sr_dev_inst *sdi,
	const sr_datafeed_meta &meta)
{
	(void)sdi;

	for (const GSList *l = meta.config; l; l = l->next) {
		const sr_config *const src = (const sr_config*)l->data;
		switch (src->key) {
		case SR_CONF_SAMPLERATE:
			/// @todo handle samplerate changes
			/// samplerate = (uint64_t *)src->value;
			break;
		default:
			// Unknown metadata is not an error.
			break;
		}
	}

	signals_changed();
}

void SigSession::feed_in_logic(const sr_datafeed_logic &logic)
{
	lock_guard<mutex> lock(_data_mutex);

	if (!_logic_data)
	{
		qDebug() << "Unexpected logic packet";
		return;
	}

	if (!_cur_logic_snapshot)
	{
		// This could be the first packet after a trigger
		set_capture_state(Running);

		// Create a new data snapshot
		_cur_logic_snapshot = shared_ptr<data::LogicSnapshot>(
			new data::LogicSnapshot(logic));
		_logic_data->push_snapshot(_cur_logic_snapshot);
	}
	else
	{
		// Append to the existing data snapshot
		_cur_logic_snapshot->append_payload(logic);
	}

	data_updated();
}

void SigSession::feed_in_analog(const sr_datafeed_analog &analog)
{
	lock_guard<mutex> lock(_data_mutex);

	const unsigned int probe_count = g_slist_length(analog.probes);
	const size_t sample_count = analog.num_samples / probe_count;
	const float *data = analog.data;
	bool sweep_beginning = false;

	for (GSList *p = analog.probes; p; p = p->next)
	{
		shared_ptr<data::AnalogSnapshot> snapshot;

		sr_probe *const probe = (sr_probe*)p->data;
		assert(probe);

		// Try to get the snapshot of the probe
		const map< const sr_probe*, shared_ptr<data::AnalogSnapshot> >::
			iterator iter = _cur_analog_snapshots.find(probe);
		if (iter != _cur_analog_snapshots.end())
			snapshot = (*iter).second;
		else
		{
			// If no snapshot was found, this means we havn't
			// created one yet. i.e. this is the first packet
			// in the sweep containing this snapshot.
			sweep_beginning = true;

			// Create a snapshot, keep it in the maps of probes
			snapshot = shared_ptr<data::AnalogSnapshot>(
				new data::AnalogSnapshot());
			_cur_analog_snapshots[probe] = snapshot;

			// Find the annalog data associated with the probe
			shared_ptr<view::AnalogSignal> sig =
				dynamic_pointer_cast<view::AnalogSignal>(
					signal_from_probe(probe));
			assert(sig);

			shared_ptr<data::Analog> data(sig->analog_data());
			assert(data);

			// Push the snapshot into the analog data.
			data->push_snapshot(snapshot);
		}

		assert(snapshot);

		// Append the samples in the snapshot
		snapshot->append_interleaved_samples(data++, sample_count,
			probe_count);
	}

	if (sweep_beginning) {
		// This could be the first packet after a trigger
		set_capture_state(Running);
	}

	data_updated();
}

void SigSession::data_feed_in(const struct sr_dev_inst *sdi,
	const struct sr_datafeed_packet *packet)
{
	assert(sdi);
	assert(packet);

	switch (packet->type) {
	case SR_DF_HEADER:
		feed_in_header(sdi);
		break;

	case SR_DF_META:
		assert(packet->payload);
		feed_in_meta(sdi,
			*(const sr_datafeed_meta*)packet->payload);
		break;

	case SR_DF_LOGIC:
		assert(packet->payload);
		feed_in_logic(*(const sr_datafeed_logic*)packet->payload);
		break;

	case SR_DF_ANALOG:
		assert(packet->payload);
		feed_in_analog(*(const sr_datafeed_analog*)packet->payload);
		break;

	case SR_DF_END:
	{
		{
			lock_guard<mutex> lock(_data_mutex);
			_cur_logic_snapshot.reset();
			_cur_analog_snapshots.clear();
		}
		data_updated();
		break;
	}
	}
}

void SigSession::data_feed_in_proc(const struct sr_dev_inst *sdi,
	const struct sr_datafeed_packet *packet, void *cb_data)
{
	(void) cb_data;
	assert(_session);
	_session->data_feed_in(sdi, packet);
}

} // namespace pv