You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
642 lines
15 KiB
642 lines
15 KiB
/////////////////////////////////////////////////////////////////////////////////// |
|
// Copyright (C) 2012 maintech GmbH, Otto-Hahn-Str. 15, 97204 Hoechberg, Germany // |
|
// written by Christian Daniel // |
|
// // |
|
// 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 as version 3 of the License, or // |
|
// // |
|
// 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 V3 for more details. // |
|
// // |
|
// You should have received a copy of the GNU General Public License // |
|
// along with this program. If not, see <http://www.gnu.org/licenses/>. // |
|
/////////////////////////////////////////////////////////////////////////////////// |
|
|
|
// FIXME: FCD is handled very badly! |
|
|
|
#include <QDebug> |
|
#include <string.h> |
|
#include <errno.h> |
|
|
|
#include "dsp/dspcommands.h" |
|
#include "dsp/dspengine.h" |
|
#include "fcdproinput.h" |
|
|
|
#include <device/devicesourceapi.h> |
|
|
|
#include "fcdprogui.h" |
|
#include "fcdprothread.h" |
|
#include "fcdtraits.h" |
|
#include "fcdproconst.h" |
|
|
|
MESSAGE_CLASS_DEFINITION(FCDProInput::MsgConfigureFCD, Message) |
|
|
|
FCDProInput::FCDProInput(DeviceSourceAPI *deviceAPI) : |
|
m_deviceAPI(deviceAPI), |
|
m_dev(0), |
|
m_settings(), |
|
m_FCDThread(0), |
|
m_deviceDescription(fcd_traits<Pro>::displayedName), |
|
m_running(false) |
|
{ |
|
openDevice(); |
|
} |
|
|
|
FCDProInput::~FCDProInput() |
|
{ |
|
if (m_running) stop(); |
|
closeDevice(); |
|
} |
|
|
|
bool FCDProInput::openDevice() |
|
{ |
|
int device = m_deviceAPI->getSampleSourceSequence(); |
|
|
|
if (m_dev != 0) |
|
{ |
|
closeDevice(); |
|
} |
|
|
|
qDebug() << "FCDProInput::openDevice with device #" << device; |
|
|
|
m_dev = fcdOpen(fcd_traits<Pro>::vendorId, fcd_traits<Pro>::productId, device); |
|
|
|
if (m_dev == 0) |
|
{ |
|
qCritical("FCDProInput::start: could not open FCD"); |
|
return false; |
|
} |
|
|
|
return true; |
|
} |
|
|
|
bool FCDProInput::start() |
|
{ |
|
qDebug() << "FCDProInput::start"; |
|
|
|
// QMutexLocker mutexLocker(&m_mutex); |
|
|
|
if (!m_dev) { |
|
return false; |
|
} |
|
|
|
if (m_running) stop(); |
|
|
|
/* Apply settings before streaming to avoid bus contention; |
|
* there is very little spare bandwidth on a full speed USB device. |
|
* Failure is harmless if no device is found |
|
* ... This is rubbish...*/ |
|
|
|
//applySettings(m_settings, true); |
|
|
|
if(!m_sampleFifo.setSize(96000*4)) |
|
{ |
|
qCritical("Could not allocate SampleFifo"); |
|
return false; |
|
} |
|
|
|
if ((m_FCDThread = new FCDProThread(&m_sampleFifo)) == NULL) |
|
{ |
|
qFatal("out of memory"); |
|
return false; |
|
} |
|
|
|
m_FCDThread->startWork(); |
|
|
|
// mutexLocker.unlock(); |
|
applySettings(m_settings, true); |
|
|
|
qDebug("FCDProInput::started"); |
|
m_running = true; |
|
|
|
return true; |
|
} |
|
|
|
void FCDProInput::closeDevice() |
|
{ |
|
if (m_dev == 0) { // was never open |
|
return; |
|
} |
|
|
|
fcdClose(m_dev); |
|
m_dev = 0; |
|
} |
|
|
|
void FCDProInput::stop() |
|
{ |
|
// QMutexLocker mutexLocker(&m_mutex); |
|
|
|
if (m_FCDThread) |
|
{ |
|
m_FCDThread->stopWork(); |
|
// wait for thread to quit ? |
|
delete m_FCDThread; |
|
m_FCDThread = 0; |
|
} |
|
|
|
m_running = false; |
|
} |
|
|
|
const QString& FCDProInput::getDeviceDescription() const |
|
{ |
|
return m_deviceDescription; |
|
} |
|
|
|
int FCDProInput::getSampleRate() const |
|
{ |
|
return fcd_traits<Pro>::sampleRate; |
|
} |
|
|
|
quint64 FCDProInput::getCenterFrequency() const |
|
{ |
|
return m_settings.m_centerFrequency; |
|
} |
|
|
|
bool FCDProInput::handleMessage(const Message& message) |
|
{ |
|
if(MsgConfigureFCD::match(message)) |
|
{ |
|
qDebug() << "FCDProInput::handleMessage: MsgConfigureFCD"; |
|
MsgConfigureFCD& conf = (MsgConfigureFCD&) message; |
|
applySettings(conf.getSettings(), false); |
|
return true; |
|
} |
|
else |
|
{ |
|
return false; |
|
} |
|
} |
|
|
|
void FCDProInput::applySettings(const FCDProSettings& settings, bool force) |
|
{ |
|
bool signalChange = false; |
|
|
|
if ((m_settings.m_centerFrequency != settings.m_centerFrequency) || force) |
|
{ |
|
qDebug() << "FCDProInput::applySettings: fc: " << settings.m_centerFrequency; |
|
m_settings.m_centerFrequency = settings.m_centerFrequency; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_center_freq((double) m_settings.m_centerFrequency); |
|
} |
|
|
|
signalChange = true; |
|
} |
|
|
|
if ((m_settings.m_lnaGainIndex != settings.m_lnaGainIndex) || force) |
|
{ |
|
m_settings.m_lnaGainIndex = settings.m_lnaGainIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_lnaGain(settings.m_lnaGainIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_rfFilterIndex != settings.m_rfFilterIndex) || force) |
|
{ |
|
m_settings.m_rfFilterIndex = settings.m_rfFilterIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_rfFilter(settings.m_rfFilterIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_lnaEnhanceIndex != settings.m_lnaEnhanceIndex) || force) |
|
{ |
|
m_settings.m_lnaEnhanceIndex = settings.m_lnaEnhanceIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_lnaEnhance(settings.m_lnaEnhanceIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_bandIndex != settings.m_bandIndex) || force) |
|
{ |
|
m_settings.m_bandIndex = settings.m_bandIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_band(settings.m_bandIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_mixerGainIndex != settings.m_mixerGainIndex) || force) |
|
{ |
|
m_settings.m_mixerGainIndex = settings.m_mixerGainIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_mixerGain(settings.m_mixerGainIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_mixerFilterIndex != settings.m_mixerFilterIndex) || force) |
|
{ |
|
m_settings.m_mixerFilterIndex = settings.m_mixerFilterIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_mixerFilter(settings.m_mixerFilterIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_biasCurrentIndex != settings.m_biasCurrentIndex) || force) |
|
{ |
|
m_settings.m_biasCurrentIndex = settings.m_biasCurrentIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_biasCurrent(settings.m_biasCurrentIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_modeIndex != settings.m_modeIndex) || force) |
|
{ |
|
m_settings.m_modeIndex = settings.m_modeIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_mode(settings.m_modeIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_gain1Index != settings.m_gain1Index) || force) |
|
{ |
|
m_settings.m_gain1Index = settings.m_gain1Index; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_gain1(settings.m_gain1Index); |
|
} |
|
} |
|
|
|
if ((m_settings.m_rcFilterIndex != settings.m_rcFilterIndex) || force) |
|
{ |
|
m_settings.m_rcFilterIndex = settings.m_rcFilterIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_rcFilter(settings.m_rcFilterIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_gain2Index != settings.m_gain2Index) || force) |
|
{ |
|
m_settings.m_gain2Index = settings.m_gain2Index; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_gain2(settings.m_gain2Index); |
|
} |
|
} |
|
|
|
if ((m_settings.m_gain3Index != settings.m_gain3Index) || force) |
|
{ |
|
m_settings.m_gain3Index = settings.m_gain3Index; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_gain3(settings.m_gain3Index); |
|
} |
|
} |
|
|
|
if ((m_settings.m_gain4Index != settings.m_gain4Index) || force) |
|
{ |
|
m_settings.m_gain4Index = settings.m_gain4Index; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_gain4(settings.m_gain4Index); |
|
} |
|
} |
|
|
|
if ((m_settings.m_ifFilterIndex != settings.m_ifFilterIndex) || force) |
|
{ |
|
m_settings.m_ifFilterIndex = settings.m_ifFilterIndex; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_ifFilter(settings.m_ifFilterIndex); |
|
} |
|
} |
|
|
|
if ((m_settings.m_gain5Index != settings.m_gain5Index) || force) |
|
{ |
|
m_settings.m_gain5Index = settings.m_gain5Index; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_gain5(settings.m_gain5Index); |
|
} |
|
} |
|
|
|
if ((m_settings.m_gain6Index != settings.m_gain6Index) || force) |
|
{ |
|
m_settings.m_gain6Index = settings.m_gain6Index; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_gain6(settings.m_gain6Index); |
|
} |
|
} |
|
|
|
if ((m_settings.m_LOppmTenths != settings.m_LOppmTenths) || force) |
|
{ |
|
m_settings.m_LOppmTenths = settings.m_LOppmTenths; |
|
|
|
if (m_dev != 0) |
|
{ |
|
set_lo_ppm(); |
|
} |
|
} |
|
|
|
if ((m_settings.m_dcBlock != settings.m_dcBlock) || force) |
|
{ |
|
m_settings.m_dcBlock = settings.m_dcBlock; |
|
m_deviceAPI->configureCorrections(m_settings.m_dcBlock, m_settings.m_iqCorrection); |
|
} |
|
|
|
if ((m_settings.m_iqCorrection != settings.m_iqCorrection) || force) |
|
{ |
|
m_settings.m_iqCorrection = settings.m_iqCorrection; |
|
m_deviceAPI->configureCorrections(m_settings.m_dcBlock, m_settings.m_iqCorrection); |
|
} |
|
|
|
if (signalChange) |
|
{ |
|
DSPSignalNotification *notif = new DSPSignalNotification(fcd_traits<Pro>::sampleRate, m_settings.m_centerFrequency); |
|
m_deviceAPI->getDeviceInputMessageQueue()->push(notif); |
|
} |
|
} |
|
|
|
void FCDProInput::set_center_freq(double freq) |
|
{ |
|
freq += freq*(((double) m_settings.m_LOppmTenths)/10000000.0); |
|
|
|
if (fcdAppSetFreq(m_dev, freq) == FCD_MODE_NONE) |
|
{ |
|
qDebug("No FCD HID found for frquency change"); |
|
} |
|
|
|
} |
|
|
|
void FCDProInput::set_bias_t(bool on) |
|
{ |
|
quint8 cmd = on ? 1 : 0; |
|
|
|
// TODO: use FCD Pro controls |
|
//fcdAppSetParam(m_dev, FCD_CMD_APP_SET_BIAS_TEE, &cmd, 1); |
|
} |
|
|
|
void FCDProInput::set_lnaGain(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_lna_gain_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::lna_gains[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_LNA_GAIN, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_lnaGain: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_rfFilter(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_rf_filter_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::rf_filters[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_RF_FILTER, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_rfFilter: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_lnaEnhance(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_lna_enhance_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::lna_enhances[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_LNA_ENHANCE, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_lnaEnhance: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_band(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_band_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::bands[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_BAND, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_band: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_mixerGain(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_mixer_gain_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::mixer_gains[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_MIXER_GAIN, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_mixerGain: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_mixerFilter(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_mixer_filter_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::mixer_filters[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_MIXER_FILTER, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_mixerFilter: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_biasCurrent(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_bias_current_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::bias_currents[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_BIAS_CURRENT, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_biasCurrent: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_mode(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_gain_mode_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_gain_modes[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_GAIN_MODE, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_mode: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_gain1(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_gain1_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_gains1[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_GAIN1, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_gain1: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_rcFilter(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_rc_filter_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_rc_filters[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_RC_FILTER, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_rcFilter: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_gain2(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_gain2_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_gains2[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_GAIN2, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_gain2: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_gain3(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_gain3_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_gains3[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_GAIN3, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_gain3: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_gain4(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_gain4_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_gains4[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_GAIN4, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_gain4: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_ifFilter(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_filter_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_filters[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_FILTER, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_ifFilter: failed to set at " << cmd_value; |
|
} |
|
|
|
} |
|
|
|
void FCDProInput::set_gain5(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_gain5_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_gains5[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_GAIN5, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_gain5: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_gain6(int index) |
|
{ |
|
if ((index < 0) || (index >= FCDProConstants::fcdpro_if_gain6_nb_values())) |
|
{ |
|
return; |
|
} |
|
|
|
quint8 cmd_value = FCDProConstants::if_gains6[index].value; |
|
|
|
if (fcdAppSetParam(m_dev, FCDPRO_HID_CMD_SET_IF_GAIN6, &cmd_value, 1) != FCD_MODE_APP) |
|
{ |
|
qWarning() << "FCDProPlusInput::set_gain6: failed to set at " << cmd_value; |
|
} |
|
} |
|
|
|
void FCDProInput::set_lo_ppm() |
|
{ |
|
set_center_freq((double) m_settings.m_centerFrequency); |
|
}
|
|
|