/* (C)2015 John Greb
 *
 * Funcube Dongle command line interface
 * Copyright 2011 David Pello EA1IDZ
 * Copyright 2011 Pieter-Tjerk de Boer PA3FWM
 * Copyright 2012-2014 Alexandru Csete OZ9AEC
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public Licence version 3.
 */

#include "fcdinput.h"
#include "fcdthread.h"
#include "qthid.h"

bool FCDThread::OpenSource(const char* cardname)
{
	bool fail = false;
	snd_pcm_hw_params_t* params;
	//fcd_rate = FCDPP_RATE;
	//fcd_channels =2;
	//fcd_format = SND_PCM_SFMT_U16_LE;
	snd_pcm_stream_t fcd_stream = SND_PCM_STREAM_CAPTURE;

	if (fcd_handle)
		return false;
	if ( snd_pcm_open( &fcd_handle, cardname, fcd_stream, 0 ) < 0 )
		return false;

	snd_pcm_hw_params_alloca(&params);
	if ( snd_pcm_hw_params_any(fcd_handle, params) < 0 )
		fail = true;
	else 	if ( snd_pcm_hw_params(fcd_handle, params) < 0 ) {
			fail = true;
			// TODO: check actual samplerate, may be crippled firmware
		} else {
			if ( snd_pcm_start(fcd_handle) < 0 )
				fail = true;
		}
	if (fail) {
		qCritical("Funcube Dongle stream start failed");
		snd_pcm_close( fcd_handle );
		return false;
	} else {
		qDebug("Funcube stream started");
	}
	return true;
}

void FCDThread::CloseSource()
{
	if (fcd_handle)
		snd_pcm_close( fcd_handle );
	fcd_handle = NULL;
}

void FCDInput::set_center_freq(double freq)
{
        if (fcdAppSetFreq(freq) == FCD_MODE_NONE)
		qDebug("No FCD HID found for frquency change");
}

void FCDInput::set_bias_t(bool on)
{
	quint8 cmd = on ? 1 : 0;

	fcdAppSetParam(FCD_CMD_APP_SET_BIAS_TEE, &cmd, 1);
}

void FCDInput::set_lna_gain(bool on)
{
	quint8 cmd = on ? 1 : 0;

	fcdAppSetParam(FCD_CMD_APP_SET_LNA_GAIN, &cmd, 1);
}

int FCDThread::work(int n_items)
{
	int l;
	SampleVector::iterator it;
	void *out;

	it = m_convertBuffer.begin();
	out = (void *)&it[0];
	l = snd_pcm_mmap_readi(fcd_handle, out, (snd_pcm_uframes_t)n_items);
	if (l > 0)
		m_sampleFifo->write(it, it + l);
	if (l == -EPIPE) {
		qDebug("FCD: Overrun detected");
		return 0;
	}
	return l;
}