LibrePilot/ground/openpilotgcs/src/plugins/pipxtreme/pipxtremegadgetwidget.cpp

/**
 ******************************************************************************
 *
 * @file       pipxtremegadgetwidget.cpp
 * @author     The OpenPilot Team, http://www.openpilot.org Copyright (C) 2010.
 * @addtogroup GCSPlugins GCS Plugins
 * @{
 * @{
 *****************************************************************************/
/*
 * 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 3 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.,
 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 */

#include <QDebug>
#include <QtOpenGL/QGLWidget>
#include <stdlib.h>

#include "pipxtremegadgetwidget.h"

//#include <aggregation/aggregate.h>

#define NO_PORT					0
#define SERIAL_PORT				1
#define USB_PORT				2

// ***************************************************************************************
// config packet details

#define MAX_RETRIES					7
#define RETRY_TIME					500		// ms

#define PIPX_HEADER_MARKER					0x76b38a52

#define PIPX_PACKET_TYPE_REQ_DETAILS		0
#define PIPX_PACKET_TYPE_DETAILS			1
#define PIPX_PACKET_TYPE_REQ_SETTINGS		2
#define PIPX_PACKET_TYPE_SETTINGS			3
#define PIPX_PACKET_TYPE_REQ_STATE			4
#define PIPX_PACKET_TYPE_STATE				5

enum {
	freqBand_UNKNOWN = 0,
	freqBand_434MHz,
	freqBand_868MHz,
	freqBand_915MHz
};

enum {
	link_disconnected = 0,
	link_connecting,
	link_connected
};

// ***************************************************************************************

#define Poly32	0x04c11db7		// 32-bit polynomial .. this should produce the same as the STM32 hardware CRC

uint32_t CRC_Table32[] = {
		0x00000000, 0x04c11db7, 0x09823b6e, 0x0d4326d9, 0x130476dc, 0x17c56b6b, 0x1a864db2, 0x1e475005,
		0x2608edb8, 0x22c9f00f, 0x2f8ad6d6, 0x2b4bcb61, 0x350c9b64, 0x31cd86d3, 0x3c8ea00a, 0x384fbdbd,
		0x4c11db70, 0x48d0c6c7, 0x4593e01e, 0x4152fda9, 0x5f15adac, 0x5bd4b01b, 0x569796c2, 0x52568b75,
		0x6a1936c8, 0x6ed82b7f, 0x639b0da6, 0x675a1011, 0x791d4014, 0x7ddc5da3, 0x709f7b7a, 0x745e66cd,
		0x9823b6e0, 0x9ce2ab57, 0x91a18d8e, 0x95609039, 0x8b27c03c, 0x8fe6dd8b, 0x82a5fb52, 0x8664e6e5,
		0xbe2b5b58, 0xbaea46ef, 0xb7a96036, 0xb3687d81, 0xad2f2d84, 0xa9ee3033, 0xa4ad16ea, 0xa06c0b5d,
		0xd4326d90, 0xd0f37027, 0xddb056fe, 0xd9714b49, 0xc7361b4c, 0xc3f706fb, 0xceb42022, 0xca753d95,
		0xf23a8028, 0xf6fb9d9f, 0xfbb8bb46, 0xff79a6f1, 0xe13ef6f4, 0xe5ffeb43, 0xe8bccd9a, 0xec7dd02d,
		0x34867077, 0x30476dc0, 0x3d044b19, 0x39c556ae, 0x278206ab, 0x23431b1c, 0x2e003dc5, 0x2ac12072,
		0x128e9dcf, 0x164f8078, 0x1b0ca6a1, 0x1fcdbb16, 0x018aeb13, 0x054bf6a4, 0x0808d07d, 0x0cc9cdca,
		0x7897ab07, 0x7c56b6b0, 0x71159069, 0x75d48dde, 0x6b93dddb, 0x6f52c06c, 0x6211e6b5, 0x66d0fb02,
		0x5e9f46bf, 0x5a5e5b08, 0x571d7dd1, 0x53dc6066, 0x4d9b3063, 0x495a2dd4, 0x44190b0d, 0x40d816ba,
		0xaca5c697, 0xa864db20, 0xa527fdf9, 0xa1e6e04e, 0xbfa1b04b, 0xbb60adfc, 0xb6238b25, 0xb2e29692,
		0x8aad2b2f, 0x8e6c3698, 0x832f1041, 0x87ee0df6, 0x99a95df3, 0x9d684044, 0x902b669d, 0x94ea7b2a,
		0xe0b41de7, 0xe4750050, 0xe9362689, 0xedf73b3e, 0xf3b06b3b, 0xf771768c, 0xfa325055, 0xfef34de2,
		0xc6bcf05f, 0xc27dede8, 0xcf3ecb31, 0xcbffd686, 0xd5b88683, 0xd1799b34, 0xdc3abded, 0xd8fba05a,
		0x690ce0ee, 0x6dcdfd59, 0x608edb80, 0x644fc637, 0x7a089632, 0x7ec98b85, 0x738aad5c, 0x774bb0eb,
		0x4f040d56, 0x4bc510e1, 0x46863638, 0x42472b8f, 0x5c007b8a, 0x58c1663d, 0x558240e4, 0x51435d53,
		0x251d3b9e, 0x21dc2629, 0x2c9f00f0, 0x285e1d47, 0x36194d42, 0x32d850f5, 0x3f9b762c, 0x3b5a6b9b,
		0x0315d626, 0x07d4cb91, 0x0a97ed48, 0x0e56f0ff, 0x1011a0fa, 0x14d0bd4d, 0x19939b94, 0x1d528623,
		0xf12f560e, 0xf5ee4bb9, 0xf8ad6d60, 0xfc6c70d7, 0xe22b20d2, 0xe6ea3d65, 0xeba91bbc, 0xef68060b,
		0xd727bbb6, 0xd3e6a601, 0xdea580d8, 0xda649d6f, 0xc423cd6a, 0xc0e2d0dd, 0xcda1f604, 0xc960ebb3,
		0xbd3e8d7e, 0xb9ff90c9, 0xb4bcb610, 0xb07daba7, 0xae3afba2, 0xaafbe615, 0xa7b8c0cc, 0xa379dd7b,
		0x9b3660c6, 0x9ff77d71, 0x92b45ba8, 0x9675461f, 0x8832161a, 0x8cf30bad, 0x81b02d74, 0x857130c3,
		0x5d8a9099, 0x594b8d2e, 0x5408abf7, 0x50c9b640, 0x4e8ee645, 0x4a4ffbf2, 0x470cdd2b, 0x43cdc09c,
		0x7b827d21, 0x7f436096, 0x7200464f, 0x76c15bf8, 0x68860bfd, 0x6c47164a, 0x61043093, 0x65c52d24,
		0x119b4be9, 0x155a565e, 0x18197087, 0x1cd86d30, 0x029f3d35, 0x065e2082, 0x0b1d065b, 0x0fdc1bec,
		0x3793a651, 0x3352bbe6, 0x3e119d3f, 0x3ad08088, 0x2497d08d, 0x2056cd3a, 0x2d15ebe3, 0x29d4f654,
		0xc5a92679, 0xc1683bce, 0xcc2b1d17, 0xc8ea00a0, 0xd6ad50a5, 0xd26c4d12, 0xdf2f6bcb, 0xdbee767c,
		0xe3a1cbc1, 0xe760d676, 0xea23f0af, 0xeee2ed18, 0xf0a5bd1d, 0xf464a0aa, 0xf9278673, 0xfde69bc4,
		0x89b8fd09, 0x8d79e0be, 0x803ac667, 0x84fbdbd0, 0x9abc8bd5, 0x9e7d9662, 0x933eb0bb, 0x97ffad0c,
		0xafb010b1, 0xab710d06, 0xa6322bdf, 0xa2f33668, 0xbcb4666d, 0xb8757bda, 0xb5365d03, 0xb1f740b4
};

// ***************************************************************************************

// constructor
PipXtremeGadgetWidget::PipXtremeGadgetWidget(QWidget *parent) :
	QWidget(parent),
	m_widget(NULL),
	m_ioDevice(NULL),
	m_stage(PIPX_IDLE)
{
	m_widget = new Ui_PipXtremeWidget();
	m_widget->setupUi(this);

	qsrand(QDateTime::currentDateTime().toMSecsSinceEpoch());

	device_input_buffer.size = 8192;
	device_input_buffer.used = 0;
	device_input_buffer.buffer = new quint8 [device_input_buffer.size];

	memset(&pipx_config_details, 0, sizeof(pipx_config_details));
	memset(&pipx_config_settings, 0, sizeof(pipx_config_settings));

	m_widget->comboBox_SerialBaudrate->clear();
	m_widget->comboBox_SerialBaudrate->addItem("1200", 1200);
	m_widget->comboBox_SerialBaudrate->addItem("2400", 2400);
	m_widget->comboBox_SerialBaudrate->addItem("4800", 4800);
	m_widget->comboBox_SerialBaudrate->addItem("9600", 9600);
	m_widget->comboBox_SerialBaudrate->addItem("19200", 19200);
	m_widget->comboBox_SerialBaudrate->addItem("38400", 38400);
	m_widget->comboBox_SerialBaudrate->addItem("57600", 57600);
	m_widget->comboBox_SerialBaudrate->addItem("115200", 115200);
	#if (defined Q_OS_WIN)
		m_widget->comboBox_SerialBaudrate->addItem("230400", 230400);
		m_widget->comboBox_SerialBaudrate->addItem("460800", 460800);
		m_widget->comboBox_SerialBaudrate->addItem("921600", 921600);
	#endif
	m_widget->comboBox_SerialBaudrate->setCurrentIndex(m_widget->comboBox_SerialBaudrate->findText("57600"));

	m_widget->comboBox_Mode->clear();
	m_widget->comboBox_Mode->addItem("Normal", 0);
	m_widget->comboBox_Mode->addItem("Scan Spectrum", 1);
	m_widget->comboBox_Mode->addItem("Calibrate Tx Carrier Frequency", 2);
	m_widget->comboBox_Mode->addItem("Test Tx Spectrum", 3);

	m_widget->comboBox_SerialPortSpeed->clear();
	for (int i = 0; i < m_widget->comboBox_SerialBaudrate->count(); i++)
		m_widget->comboBox_SerialPortSpeed->addItem(m_widget->comboBox_SerialBaudrate->itemText(i), m_widget->comboBox_SerialBaudrate->itemData(i));
	m_widget->comboBox_SerialPortSpeed->setCurrentIndex(m_widget->comboBox_SerialPortSpeed->findText("57600"));

	m_widget->comboBox_MaxRFBandwidth->clear();
	m_widget->comboBox_MaxRFBandwidth->addItem("500", 500);
	m_widget->comboBox_MaxRFBandwidth->addItem("1000", 1000);
	m_widget->comboBox_MaxRFBandwidth->addItem("2000", 2000);
	m_widget->comboBox_MaxRFBandwidth->addItem("4000", 4000);
	m_widget->comboBox_MaxRFBandwidth->addItem("8000", 8000);
	m_widget->comboBox_MaxRFBandwidth->addItem("9600", 9600);
	m_widget->comboBox_MaxRFBandwidth->addItem("16000", 16000);
	m_widget->comboBox_MaxRFBandwidth->addItem("19200", 19200);
	m_widget->comboBox_MaxRFBandwidth->addItem("24000", 24000);
	m_widget->comboBox_MaxRFBandwidth->addItem("32000", 32000);
	m_widget->comboBox_MaxRFBandwidth->addItem("64000", 64000);
	m_widget->comboBox_MaxRFBandwidth->addItem("128000", 128000);
	m_widget->comboBox_MaxRFBandwidth->addItem("192000", 192000);
	m_widget->comboBox_MaxRFBandwidth->setCurrentIndex(m_widget->comboBox_MaxRFBandwidth->findText("128000"));

	m_widget->comboBox_MaxRFTxPower->clear();
	m_widget->comboBox_MaxRFTxPower->addItem("1.25mW", 0);
	m_widget->comboBox_MaxRFTxPower->addItem("1.6mW", 1);
	m_widget->comboBox_MaxRFTxPower->addItem("3.16mW", 2);
	m_widget->comboBox_MaxRFTxPower->addItem("6.3mW", 3);
	m_widget->comboBox_MaxRFTxPower->addItem("12.6mW", 4);
	m_widget->comboBox_MaxRFTxPower->addItem("25mW", 5);
	m_widget->comboBox_MaxRFTxPower->addItem("50mW", 6);
	m_widget->comboBox_MaxRFTxPower->addItem("100mW", 7);
	m_widget->comboBox_MaxRFTxPower->setCurrentIndex(m_widget->comboBox_MaxRFTxPower->findText("12.6mW"));

	m_widget->doubleSpinBox_Frequency->setSingleStep(0.00015625);

	m_widget->progressBar_RSSI->setMinimum(-120);
	m_widget->progressBar_RSSI->setMaximum(-20);
	m_widget->progressBar_RSSI->setValue(m_widget->progressBar_RSSI->minimum());

	m_widget->graphicsView_Spectrum->setScene(new QGraphicsScene(this));
	m_widget->graphicsView_Spectrum->setViewport(new QGLWidget(QGLFormat(QGL::SampleBuffers)));
//	m_widget->graphicsView_Spectrum->setViewport(new QWidget);
	m_widget->graphicsView_Spectrum->setCacheMode(QGraphicsView::CacheBackground);
	m_widget->graphicsView_Spectrum->setRenderHints(QPainter::Antialiasing | QPainter::TextAntialiasing | QPainter::SmoothPixmapTransform | QPainter::HighQualityAntialiasing);
	QGraphicsScene *spec_scene = m_widget->graphicsView_Spectrum->scene();
    if (spec_scene)
    {
		spec_scene->setBackgroundBrush(QColor(80, 80, 80));
        spec_scene->clear();

//        spec_scene->addItem(m_background);
//        spec_scene->addItem(m_joystickEnd);
//        spec_scene->setSceneRect(m_background->boundingRect());
    }

	m_widget->pushButton_Save->setEnabled(false);
	m_widget->pushButton_ScanSpectrum->setEnabled(false);

	QIcon rbi;
	rbi.addFile(QString(":pipxtreme/images/view-refresh.svg"));
	m_widget->refreshPorts->setIcon(rbi);

	// Listen to telemetry connection events
	ExtensionSystem::PluginManager *pluginManager = ExtensionSystem::PluginManager::instance();
	if (pluginManager)
	{
		TelemetryManager *telemetryManager = pluginManager->getObject<TelemetryManager>();
		if (telemetryManager)
		{
			connect(telemetryManager, SIGNAL(myStart()), this, SLOT(onTelemetryStart()));
			connect(telemetryManager, SIGNAL(myStop()), this, SLOT(onTelemetryStop()));
			connect(telemetryManager, SIGNAL(connected()), this, SLOT(onTelemetryConnect()));
			connect(telemetryManager, SIGNAL(disconnected()), this, SLOT(onTelemetryDisconnect()));
		}
	}

	getPorts();

	connect(m_widget->connectButton, SIGNAL(clicked()), this, SLOT(connectDisconnect()));
	connect(m_widget->refreshPorts, SIGNAL(clicked()), this, SLOT(getPorts()));
	connect(m_widget->pushButton_AESKeyRandom, SIGNAL(clicked()), this, SLOT(randomiseAESKey()));
	connect(m_widget->pushButton_ScanSpectrum, SIGNAL(clicked()), this, SLOT(scanSpectrum()));
	connect(m_widget->pushButton_Save, SIGNAL(clicked()), this, SLOT(saveToFlash()));
	connect(m_widget->lineEdit_AESKey, SIGNAL(textChanged(const QString &)), this, SLOT(textChangedAESKey(const QString &)));
}

// destructor .. this never gets called :(
PipXtremeGadgetWidget::~PipXtremeGadgetWidget()
{
	disconnectPort(false);

	device_input_buffer.mutex.lock();
		if (device_input_buffer.buffer)
		{
			delete [] device_input_buffer.buffer;
			device_input_buffer.buffer = NULL;
			device_input_buffer.size = 0;
			device_input_buffer.used = 0;
		}
	device_input_buffer.mutex.unlock();
}

// ***************************************************************************************

void PipXtremeGadgetWidget::resizeEvent(QResizeEvent *event)
{
	if (m_widget)
    {
		if (m_widget->graphicsView_Spectrum)
        {
			QGraphicsScene *spec_scene = m_widget->graphicsView_Spectrum->scene();
            if (spec_scene)
            {
//              spec_scene->setSceneRect(QRect(QPoint(0, 0), event->size()));
//              spec_scene->setBackgroundBrush(Qt::black);
            }
        }
    }

//    PipXtremeGadgetWidget::resizeEvent(event);
}

// ***************************************************************************************

void PipXtremeGadgetWidget::onComboBoxPorts_currentIndexChanged(int index)
{
	if (index < 0)
	{
		m_widget->comboBox_SerialBaudrate->setEnabled(false);
		return;
	}

	int type = m_widget->comboBox_Ports->itemData(index).toInt();

	m_widget->comboBox_SerialBaudrate->setEnabled(type == SERIAL_PORT);
}

// ***************************************************************************************

uint32_t PipXtremeGadgetWidget::updateCRC32(uint32_t crc, uint8_t b)
{
	return (crc << 8) ^ CRC_Table32[(crc >> 24) ^ b];
}

uint32_t PipXtremeGadgetWidget::updateCRC32Data(uint32_t crc, void *data, int len)
{
	register uint8_t *p = (uint8_t *)data;
	register uint32_t _crc = crc;
	for (int i = len; i > 0; i--)
		_crc = (_crc << 8) ^ CRC_Table32[(_crc >> 24) ^ *p++];
	return _crc;
}

// Generate the CRC table
void PipXtremeGadgetWidget::makeCRC_Table32()
{
	for (int i = 0; i < 256; i++)
	{
		uint32_t crc = i;
		for (int j = 8; j > 0; j--)
			crc = (crc & 1) ? (crc << 1) ^ Poly32 : crc << 1;
		CRC_Table32[i] = crc;
	}
}

// ***************************************************************************************

QString PipXtremeGadgetWidget::getSerialPortDevice(const QString &friendName)
{
	QList<QextPortInfo> ports = QextSerialEnumerator::getPorts();

	foreach (QextPortInfo port, ports)
	{
		#ifdef Q_OS_WIN
			if (port.friendName == friendName)
				return port.portName;
		#else
			if (port.friendName == friendName)
				return port.physName;
		#endif
	}

	return "";
}

bool sortSerialPorts(const QextPortInfo &s1, const QextPortInfo &s2)
{
    return (s1.portName < s2.portName);
}

void PipXtremeGadgetWidget::getPorts()
{
	disconnect(m_widget->comboBox_Ports, 0, 0, 0);

	m_widget->comboBox_Ports->clear();

    // ********************************
    // Populate the telemetry combo box with serial ports

	QList<QextPortInfo> serial_ports = QextSerialEnumerator::getPorts();

	qSort(serial_ports.begin(), serial_ports.end(), sortSerialPorts);

	QStringList list;

	foreach (QextPortInfo port, serial_ports)
       list.append(port.friendName);

	for (int i = 0; i < list.count(); i++)
		m_widget->comboBox_Ports->addItem("com: " + list.at(i), SERIAL_PORT);

    // ********************************
    // Populate the telemetry combo box with usb ports

    pjrc_rawhid *rawHidHandle = new pjrc_rawhid();
    if (rawHidHandle)
    {
        int opened = rawHidHandle->open(10, 0x20A0, 0x4117, 0xFF9C, 0x0001);
        if (opened > 0)
        {
            QList<QString> usb_ports;

            for (int i = 0; i < opened; i++)
                usb_ports.append(rawHidHandle->getserial(i));

			qSort(usb_ports.begin(), usb_ports.end());

			for (int i = 0; i < usb_ports.count(); i++)
				m_widget->comboBox_Ports->addItem("usb: " + usb_ports.at(i), USB_PORT);
        }

        delete rawHidHandle;
    }

    // ********************************

	connect(m_widget->comboBox_Ports, SIGNAL(currentIndexChanged(int)), this, SLOT(onComboBoxPorts_currentIndexChanged(int)));

	onComboBoxPorts_currentIndexChanged(m_widget->comboBox_Ports->currentIndex());

	// ********************************
}

// ***************************************************************************************

void PipXtremeGadgetWidget::onTelemetryStart()
{
	setEnabled(false);

//	m_widget->connectButton->setEnabled(false);
//	m_widget->comboBox_Ports->setEnabled(false);
//	m_widget->refreshPorts->setEnabled(false);
//	m_widget->comboBox_SerialBaudrate->setEnabled(false);
}

void PipXtremeGadgetWidget::onTelemetryStop()
{
	setEnabled(true);

//	m_widget->connectButton->setEnabled(true);
//	m_widget->comboBox_Ports->setEnabled(true);
//	m_widget->refreshPorts->setEnabled(true);
//	m_widget->comboBox_SerialBaudrate->setEnabled(true);
}

// ***************************************************************************************

void PipXtremeGadgetWidget::onTelemetryConnect()
{
}

void PipXtremeGadgetWidget::onTelemetryDisconnect()
{
}

// ***************************************************************************************

void PipXtremeGadgetWidget::disableTelemetry()
{	// Suspend telemetry & polling

	Core::ConnectionManager *cm = Core::ICore::instance()->connectionManager();
	if (!cm) return;

	cm->disconnectDevice();
	cm->suspendPolling();
}

void PipXtremeGadgetWidget::enableTelemetry()
{	// Restart the polling thread

	Core::ConnectionManager *cm = Core::ICore::instance()->connectionManager();
	if (!cm) return;

	cm->resumePolling();
}

// ***************************************************************************************

void PipXtremeGadgetWidget::randomiseAESKey()
{
	uint32_t crc = ((uint32_t)qrand() << 16) ^ qrand() ^ QDateTime::currentDateTime().toMSecsSinceEpoch();

	QString key = "";
	for (int i = 0; i < 4; i++)
	{
		for (int i = 0; i < (27 + (qrand() & 0x7f)); i++)
			crc = updateCRC32(crc, qrand());

		key += QString::number(crc, 16).rightJustified(8, '0');
	}

	m_widget->lineEdit_AESKey->setText(key);
}

void PipXtremeGadgetWidget::scanSpectrum()
{
}

void PipXtremeGadgetWidget::saveToFlash()
{
	QMutexLocker locker_dev(&device_mutex);
	QMutexLocker locker_inbuf(&device_input_buffer.mutex);

	if (!m_ioDevice) return;
	if (!m_ioDevice->isOpen()) return;

	if (pipx_config_details.serial_number == 0) return;	// we first need some details before sending new setings

	QString s;
	bool ok;

	t_pipx_config_settings settings;

	s = m_widget->lineEdit_PairedSerialNumber->text().trimmed().toLower();
	s.replace(' ', "");	// remove all spaces
	if (s.startsWith("0x"))
	{
		s.remove(0, 2);
		s = s.trimmed();
	}
	settings.destination_id = s.toUInt(&ok, 16);
	if (s.isEmpty() || !ok)
	{
		error("Check your \"Paired Serial Number\" entry!", 0);
		return;
	}

	settings.rf_xtal_cap = m_widget->spinBox_FrequencyCalibration->value();

	s = m_widget->doubleSpinBox_Frequency->text().trimmed();
	s.replace(' ', "");	// remove all spaces
	settings.frequency_Hz = (uint32_t)(s.toDouble(&ok) * 1e6);
	if (ok)	// round it to the 'frequency step size'
		settings.frequency_Hz = (uint32_t)(((double)settings.frequency_Hz + pipx_config_details.frequency_step_size / 2) / pipx_config_details.frequency_step_size) * pipx_config_details.frequency_step_size;
	if (s.isEmpty() || !ok || settings.frequency_Hz < pipx_config_details.min_frequency_Hz || settings.frequency_Hz > pipx_config_details.max_frequency_Hz)
	{
		error("Check your \"Frequency\" entry!", 0);
		return;
	}

	settings.max_rf_bandwidth = m_widget->comboBox_MaxRFBandwidth->itemData(m_widget->comboBox_MaxRFBandwidth->currentIndex()).toInt();

	settings.max_tx_power = m_widget->comboBox_MaxRFTxPower->itemData(m_widget->comboBox_MaxRFTxPower->currentIndex()).toInt();

	settings.serial_baudrate = m_widget->comboBox_SerialPortSpeed->itemData(m_widget->comboBox_SerialPortSpeed->currentIndex()).toInt();

	settings.aes_enable = m_widget->checkBox_AESEnable->isChecked();

	memset(settings.aes_key, 0, sizeof(settings.aes_key));
	s = m_widget->lineEdit_AESKey->text().trimmed();
	s.replace(' ', "");	// remove all spaces
	while (s.length() < 32) s = '0' + s;
	if (settings.aes_enable && s.length() != 32)
	{
		error("Check your \"AES Key\" entry! .. it must be 32 hex characters long", 0);
		return;
	}
	for (int i = 0; i < (int)sizeof(settings.aes_key); i++)
	{
		QString s2 = s.left(2);
		s.remove(0, 2);
		s = s.trimmed();
		settings.aes_key[i] = s2.toUInt(&ok, 16);
		if (!ok)
		{
			error("Check your \"AES Key\" entry! .. it must contain only hex characters (0-9, a-f)", 0);
			return;
		}
	}

	// send the new settings to the modem
	sendSettings(pipx_config_details.serial_number, &settings);

	// retrieve them back
	m_stage_retries = 0;
	m_stage = PIPX_REQ_SETTINGS;
}

void PipXtremeGadgetWidget::textChangedAESKey(const QString &text)
{
	QString s = text;
	s.replace(' ', "");
	m_widget->label_AESkey->setText("AES Encryption Key (" + QString::number(s.length()) + ")");
}

// ***************************************************************************************
// send various packets

void PipXtremeGadgetWidget::sendRequestDetails(uint32_t serial_number)
{
	// *****************
	// create the packet

	t_pipx_config_header header;
	header.marker = PIPX_HEADER_MARKER;
	header.serial_number = serial_number;
	header.type = PIPX_PACKET_TYPE_REQ_DETAILS;
	header.spare = 0;
	header.data_size = 0;
	header.data_crc = 0xffffffff;
	header.header_crc = 0;
	header.header_crc = updateCRC32Data(0xffffffff, &header, sizeof(t_pipx_config_header));

	// *****************
	// send the packet

//	QMutexLocker locker_dev(&device_mutex);
	if (!m_ioDevice) return;
	if (!m_ioDevice->isOpen()) return;
	qint64 bytes_written = m_ioDevice->write((const char*)&header, sizeof(t_pipx_config_header));

	Q_UNUSED(bytes_written)

	// *****************
}

void PipXtremeGadgetWidget::sendRequestSettings(uint32_t serial_number)
{
	if (serial_number == 0)
		return;

	// *****************
	// create the packet

	t_pipx_config_header header;
	header.marker = PIPX_HEADER_MARKER;
	header.serial_number = serial_number;
	header.type = PIPX_PACKET_TYPE_REQ_SETTINGS;
	header.spare = 0;
	header.data_size = 0;
	header.data_crc = 0xffffffff;
	header.header_crc = 0;
	header.header_crc = updateCRC32Data(0xffffffff, &header, sizeof(t_pipx_config_header));

	// *****************
	// send the packet

//	QMutexLocker locker_dev(&device_mutex);
	if (!m_ioDevice) return;
	if (!m_ioDevice->isOpen()) return;
	qint64 bytes_written = m_ioDevice->write((const char*)&header, sizeof(t_pipx_config_header));

//	qDebug() << "PipX m_ioDevice->write: " << QString::number(bytes_written) << endl;

	Q_UNUSED(bytes_written)

//	error("Bytes written", bytes_written);	// TEST ONLY

	// *****************
}

void PipXtremeGadgetWidget::sendRequestState(uint32_t serial_number)
{
	if (serial_number == 0)
		return;

	// *****************
	// create the packet

	t_pipx_config_header header;
	header.marker = PIPX_HEADER_MARKER;
	header.serial_number = serial_number;
	header.type = PIPX_PACKET_TYPE_REQ_STATE;
	header.spare = 0;
	header.data_size = 0;
	header.data_crc = 0xffffffff;
	header.header_crc = 0;
	header.header_crc = updateCRC32Data(0xffffffff, &header, sizeof(t_pipx_config_header));

	// *****************
	// send the packet

//	QMutexLocker locker_dev(&device_mutex);
	if (!m_ioDevice) return;
	if (!m_ioDevice->isOpen()) return;
	qint64 bytes_written = m_ioDevice->write((const char*)&header, sizeof(t_pipx_config_header));

//	qDebug() << "PipX m_ioDevice->write: " << QString::number(bytes_written) << endl;

	Q_UNUSED(bytes_written)

//	error("Bytes written", bytes_written);	// TEST ONLY

	// *****************
}

void PipXtremeGadgetWidget::sendSettings(uint32_t serial_number, t_pipx_config_settings *settings)
{
	if (serial_number == 0)
		return;

	if (!settings)
		return;

	uint8_t buffer[sizeof(t_pipx_config_header) + sizeof(t_pipx_config_settings)];

	t_pipx_config_header *header = (t_pipx_config_header *)buffer;
	uint8_t *data = (uint8_t *) header + sizeof(t_pipx_config_header);

	// *****************
	// create the packet

	memcpy(data, settings, sizeof(t_pipx_config_settings));

	header->marker = PIPX_HEADER_MARKER;
	header->serial_number = serial_number;
	header->type = PIPX_PACKET_TYPE_SETTINGS;
	header->spare = 0;
	header->data_size = sizeof(t_pipx_config_settings);
	header->data_crc = updateCRC32Data(0xffffffff, data, header->data_size);
	header->header_crc = 0;
	header->header_crc = updateCRC32Data(0xffffffff, header, sizeof(t_pipx_config_header));

	// *****************
	// send the packet

//	QMutexLocker locker_dev(&device_mutex);
	if (!m_ioDevice) return;
	if (!m_ioDevice->isOpen()) return;
	qint64 bytes_written = m_ioDevice->write((const char*)buffer, sizeof(t_pipx_config_header) + header->data_size);

//	error("Bytes written", bytes_written);	// TEST ONLY

	Q_UNUSED(bytes_written)

	// *****************
}

// ***************************************************************************************
// process rx stream data

void PipXtremeGadgetWidget::processRxStream()
{
	QMutexLocker locker_dev(&device_mutex);
	QMutexLocker locker_inbuf(&device_input_buffer.mutex);

	if (!m_ioDevice) return;
	if (!m_ioDevice->isOpen()) return;

	QTimer::singleShot(100, this, SLOT(processRxStream()));

	qint64 bytes_available = m_ioDevice->bytesAvailable();
	if (bytes_available <= 0) return;

	// ensure we have buffer space for the new data
	if (!device_input_buffer.buffer)
	{	// allocate a buffer for the data
		device_input_buffer.size = bytes_available * 2;
		device_input_buffer.used = 0;
		device_input_buffer.buffer = new quint8 [device_input_buffer.size];
		if (!device_input_buffer.buffer) return;
	}
	else
	{
		if ((device_input_buffer.used + (bytes_available * 2)) > device_input_buffer.size)
		{	// need to increase the buffer size

			// create a new larger buffer
			int new_size = device_input_buffer.used + bytes_available * 2;
			quint8 *new_buf = new quint8 [new_size];
			if (!new_buf) return;

			// copy the data from the old buffer into the new buffer
			memmove(new_buf, device_input_buffer.buffer, device_input_buffer.used);

			// delete the old buffer
			delete [] device_input_buffer.buffer;

			// keep the new buffer
			device_input_buffer.buffer = new_buf;
			device_input_buffer.size = new_size;
		}
	}

	// add the new data into the buffer
	qint64 bytes_read = m_ioDevice->read((char *)(device_input_buffer.buffer + device_input_buffer.used), device_input_buffer.size - device_input_buffer.used);
	if (bytes_read <= 0) return;
	device_input_buffer.used += bytes_read;

	processRxBuffer();
}

void PipXtremeGadgetWidget::processRxBuffer()
{	// scan the buffer for a valid packet

	if (!device_input_buffer.buffer || device_input_buffer.used < (int)sizeof(t_pipx_config_header))
		return;	// no data as yet or not yet enough data

	while (device_input_buffer.used >= (int)sizeof(t_pipx_config_header))
	{
		uint32_t crc1, crc2;

		t_pipx_config_header *header = (t_pipx_config_header *)device_input_buffer.buffer;
		uint8_t *data = (uint8_t *)header + sizeof(t_pipx_config_header);

		// check packet marker
		if (header->marker != PIPX_HEADER_MARKER)
		{	// marker not yet found
			// remove a byte
			int i = 1;
			if (i < device_input_buffer.used)
				memmove(device_input_buffer.buffer, device_input_buffer.buffer + i, device_input_buffer.used - i);
			device_input_buffer.used -= i;
			continue;
		}

		// check the header CRC
		crc1 = header->header_crc;
		header->header_crc = 0;
		crc2 = updateCRC32Data(0xffffffff, header, sizeof(t_pipx_config_header));
		header->header_crc = crc1;
		if (crc2 != crc1)
		{	// faulty header
			int i = 1;
			if (i < device_input_buffer.used)
				memmove(device_input_buffer.buffer, device_input_buffer.buffer + i, device_input_buffer.used - i);
			device_input_buffer.used -= i;
			continue;
		}

		// valid error free header found!

		int total_packet_size = sizeof(t_pipx_config_header) + header->data_size;

		if (device_input_buffer.used < total_packet_size)
		{	// not yet got a full packet
			break;
		}

		if (header->data_size > 0)
		{
			// check the data crc
			crc1 = header->data_crc;
			crc2 = updateCRC32Data(0xffffffff, data, header->data_size);
			if (crc2 != crc1)
			{	// faulty data
				int i = 1;
				if (i < device_input_buffer.used)
					memmove(device_input_buffer.buffer, device_input_buffer.buffer + i, device_input_buffer.used - i);
				device_input_buffer.used -= i;
				continue;
			}
		}

		processRxPacket(device_input_buffer.buffer, total_packet_size);

		// remove the packet from the buffer
		if (total_packet_size < device_input_buffer.used)
			memmove(device_input_buffer.buffer, device_input_buffer.buffer + total_packet_size, device_input_buffer.used - total_packet_size);
		device_input_buffer.used -= total_packet_size;
	}
}

void PipXtremeGadgetWidget::processRxPacket(quint8 *packet, int packet_size)
{
	if (!packet || packet_size <= 0)
		return;

	t_pipx_config_header *header = (t_pipx_config_header *)packet;
	uint8_t *data = (uint8_t *)header + sizeof(t_pipx_config_header);

	switch (header->type)
	{
		case PIPX_PACKET_TYPE_REQ_DETAILS:
			break;

		case PIPX_PACKET_TYPE_DETAILS:
			if (m_stage == PIPX_REQ_DETAILS)
			{
				m_stage_retries = 0;
				m_stage = PIPX_REQ_SETTINGS;

				if (packet_size < (int)sizeof(t_pipx_config_header) + (int)sizeof(t_pipx_config_details))
					break;	// packet size is too small - error

				memcpy(&pipx_config_details, data, sizeof(t_pipx_config_details));

				m_widget->lineEdit_FirmwareVersion->setText(QString::number(pipx_config_details.major_version) + "." + QString::number(pipx_config_details.minor_version));

				m_widget->lineEdit_SerialNumber->setText(QString::number(pipx_config_details.serial_number, 16).toUpper());

				if (pipx_config_details.frequency_band == freqBand_434MHz)
					m_widget->lineEdit_FrequencyBand->setText("434MHz");
				else
				if (pipx_config_details.frequency_band == freqBand_868MHz)
					m_widget->lineEdit_FrequencyBand->setText("868MHz");
				else
				if (pipx_config_details.frequency_band == freqBand_915MHz)
					m_widget->lineEdit_FrequencyBand->setText("915MHz");
				else
					m_widget->lineEdit_FrequencyBand->setText("UNKNOWN [" + QString::number(pipx_config_details.frequency_band) + "]");

				m_widget->lineEdit_MinFrequency->setText(QString::number((double)pipx_config_details.min_frequency_Hz / 1e6, 'f', 6) + "MHz");
				m_widget->lineEdit_MaxFrequency->setText(QString::number((double)pipx_config_details.max_frequency_Hz / 1e6, 'f', 6) + "MHz");

				m_widget->doubleSpinBox_Frequency->setMinimum((double)pipx_config_details.min_frequency_Hz / 1e6);
				m_widget->doubleSpinBox_Frequency->setMaximum((double)pipx_config_details.max_frequency_Hz / 1e6);

				m_widget->lineEdit_FrequencyStepSize->setText(QString::number(pipx_config_details.frequency_step_size, 'f', 2) + "Hz");

				m_widget->pushButton_Save->setEnabled(true);
				m_widget->pushButton_ScanSpectrum->setEnabled(true);
			}
			break;

		case PIPX_PACKET_TYPE_REQ_SETTINGS:
			break;

		case PIPX_PACKET_TYPE_SETTINGS:
			if (m_stage == PIPX_REQ_SETTINGS && pipx_config_details.serial_number != 0)
			{
				if (packet_size < (int)sizeof(t_pipx_config_header) + (int)sizeof(t_pipx_config_settings))
					break;	// packet size is too small - error

				m_stage_retries = 0;
				m_stage = PIPX_REQ_STATE;

				memcpy(&pipx_config_settings, data, sizeof(t_pipx_config_settings));

				m_widget->lineEdit_PairedSerialNumber->setText(QString::number(pipx_config_settings.destination_id, 16).toUpper());
				m_widget->spinBox_FrequencyCalibration->setValue(pipx_config_settings.rf_xtal_cap);

				m_widget->doubleSpinBox_Frequency->setValue((double)pipx_config_settings.frequency_Hz / 1e6);

				m_widget->comboBox_MaxRFBandwidth->setCurrentIndex(m_widget->comboBox_MaxRFBandwidth->findData(pipx_config_settings.max_rf_bandwidth));

				m_widget->comboBox_MaxRFTxPower->setCurrentIndex(m_widget->comboBox_MaxRFTxPower->findData(pipx_config_settings.max_tx_power));

				m_widget->comboBox_SerialPortSpeed->setCurrentIndex(m_widget->comboBox_SerialPortSpeed->findData(pipx_config_settings.serial_baudrate));

				QString key = "";
				for (int i = 0; i < (int)sizeof(pipx_config_settings.aes_key); i++)
					key += QString::number(pipx_config_settings.aes_key[i], 16).rightJustified(2, '0');
				m_widget->lineEdit_AESKey->setText(key);
				m_widget->checkBox_AESEnable->setChecked(pipx_config_settings.aes_enable);
			}

			break;

		case PIPX_PACKET_TYPE_REQ_STATE:
			break;

		case PIPX_PACKET_TYPE_STATE:
			if (m_stage == PIPX_REQ_STATE && pipx_config_details.serial_number != 0)
			{
				if (packet_size < (int)sizeof(t_pipx_config_header) + (int)sizeof(t_pipx_config_state))
					break;	// packet size is too small - error

				m_stage_retries = 0;
//				m_stage = PIPX_REQ_STATE;

				memcpy(&pipx_config_state, data, sizeof(t_pipx_config_state));

				switch (pipx_config_state.link_state)
				{
					case link_disconnected:
						m_widget->lineEdit_LinkState->setText("Disconnected");
						break;
					case link_connecting:
						m_widget->lineEdit_LinkState->setText("Connecting");
						break;
					case link_connected:
						m_widget->lineEdit_LinkState->setText("Connected");
						break;
					default:
						m_widget->lineEdit_LinkState->setText("Unknown [" + QString::number(pipx_config_state.link_state) + "]");
						break;
				}
				if (pipx_config_state.rssi < m_widget->progressBar_RSSI->minimum())
					m_widget->progressBar_RSSI->setValue(m_widget->progressBar_RSSI->minimum());
				else
				if (pipx_config_state.rssi > m_widget->progressBar_RSSI->maximum())
					m_widget->progressBar_RSSI->setValue(m_widget->progressBar_RSSI->maximum());
				else
					m_widget->progressBar_RSSI->setValue(pipx_config_state.rssi);
				m_widget->lineEdit_RxAFC->setText(QString::number(pipx_config_state.afc) + "Hz");
				m_widget->lineEdit_Retries->setText(QString::number(pipx_config_state.retries));
			}

			break;

		default:
			break;
	}
}


// ***************************************************************************************

void PipXtremeGadgetWidget::processStream()
{
	QMutexLocker locker_dev(&device_mutex);
	QMutexLocker locker_inbuf(&device_input_buffer.mutex);

	if (!m_ioDevice) return;
	if (!m_ioDevice->isOpen()) return;

	switch (m_stage)
	{
		case PIPX_IDLE:
			QTimer::singleShot(RETRY_TIME, this, SLOT(processStream()));
			break;

		case PIPX_REQ_DETAILS:
			if (++m_stage_retries > MAX_RETRIES)
			{
				disconnectPort(true, false);
				break;
			}
			sendRequestDetails(0);
			QTimer::singleShot(RETRY_TIME, this, SLOT(processStream()));
			break;

		case PIPX_REQ_SETTINGS:
			if (++m_stage_retries > MAX_RETRIES)
			{
				disconnectPort(true, false);
				break;
			}
			sendRequestSettings(pipx_config_details.serial_number);
			QTimer::singleShot(RETRY_TIME, this, SLOT(processStream()));
			break;

		case PIPX_REQ_STATE:
			if (++m_stage_retries > MAX_RETRIES)
			{
				disconnectPort(true, false);
				break;
			}
			sendRequestState(pipx_config_details.serial_number);
			QTimer::singleShot(RETRY_TIME, this, SLOT(processStream()));
			break;

		default:
			m_stage_retries = 0;
			m_stage = PIPX_IDLE;
			QTimer::singleShot(RETRY_TIME, this, SLOT(processStream()));
			break;
	}
}

// ***************************************************************************************

void PipXtremeGadgetWidget::disconnectPort(bool enable_telemetry, bool lock_stuff)
{	// disconnect the comms port

	if (lock_stuff)
	{
		QMutexLocker locker_dev(&device_mutex);
		QMutexLocker locker_inbuf(&device_input_buffer.mutex);
	}

	m_stage_retries = 0;
	m_stage = PIPX_IDLE;

	device_input_buffer.used = 0;

	memset(&pipx_config_details, 0, sizeof(pipx_config_details));
	memset(&pipx_config_settings, 0, sizeof(pipx_config_settings));

	if (m_ioDevice)
	{
		m_ioDevice->close();
		disconnect(m_ioDevice, 0, 0, 0);
		delete m_ioDevice;
		m_ioDevice = NULL;
	}

	m_widget->connectButton->setText("Connect");
	m_widget->comboBox_SerialBaudrate->setEnabled(true);
	m_widget->comboBox_Ports->setEnabled(true);
	m_widget->refreshPorts->setEnabled(true);
	m_widget->pushButton_ScanSpectrum->setEnabled(false);
	m_widget->pushButton_Save->setEnabled(false);

	m_widget->lineEdit_FirmwareVersion->setText("");
	m_widget->lineEdit_SerialNumber->setText("");
	m_widget->lineEdit_FrequencyBand->setText("");
	m_widget->lineEdit_MinFrequency->setText("");
	m_widget->lineEdit_MaxFrequency->setText("");
	m_widget->lineEdit_FrequencyStepSize->setText("");
	m_widget->lineEdit_LinkState->setText("");
	m_widget->progressBar_RSSI->setValue(m_widget->progressBar_RSSI->minimum());
	m_widget->lineEdit_RxAFC->setText("");
	m_widget->lineEdit_Retries->setText("");
	m_widget->lineEdit_PairedSerialNumber->setText("");
	m_widget->spinBox_FrequencyCalibration->setValue(0);
	m_widget->doubleSpinBox_Frequency->setValue(0);
	m_widget->lineEdit_AESKey->setText("");
	m_widget->checkBox_AESEnable->setChecked(false);

	if (enable_telemetry)
		enableTelemetry();
}

void PipXtremeGadgetWidget::connectPort()
{	// connect the comms port

	disconnectPort(true);

	QMutexLocker locker_dev(&device_mutex);

	int device_idx = m_widget->comboBox_Ports->currentIndex();
	if (device_idx < 0)
		return;

	QString device_str = m_widget->comboBox_Ports->currentText().trimmed();
	if (device_str.isEmpty())
		return;

	int type = NO_PORT;
	if (device_str.toLower().startsWith("com: "))
	{
		type = SERIAL_PORT;
		device_str.remove(0, 5);
		device_str = device_str.trimmed();
	}
	else
	if (device_str.toLower().startsWith("usb: "))
	{
		type = USB_PORT;
		device_str.remove(0, 5);
		device_str = device_str.trimmed();
	}

//	type = m_widget->comboBox_Ports->itemData(device_idx).toInt();

//	qDebug() << QString::number(type) << ": " << device_str;

	// Suspend GCS telemety & polling
	disableTelemetry();

	switch (type)
	{
		case SERIAL_PORT:	// serial port
			{
				QString str = getSerialPortDevice(device_str);
				if (str.isEmpty())
					break;

				int br_idx = m_widget->comboBox_SerialBaudrate->currentIndex();
				if (br_idx < 0)
					break;

				int baudrate = m_widget->comboBox_SerialBaudrate->itemData(br_idx).toInt();

				BaudRateType bdt = BAUD57600;
				switch (baudrate)
				{
					case 1200: bdt = BAUD1200; break;
					case 2400: bdt = BAUD2400; break;
					case 4800: bdt = BAUD4800; break;
					case 9600: bdt = BAUD9600; break;
					case 19200: bdt = BAUD19200; break;
					case 38400: bdt = BAUD38400; break;
					case 57600: bdt = BAUD57600; break;
					case 115200: bdt = BAUD115200; break;
					case 128000: bdt = BAUD128000; break;
					case 256000: bdt = BAUD256000; break;
					#if (defined Q_OS_WIN)
						case 230400: bdt = BAUD230400; break;
						case 460800: bdt = BAUD460800; break;
						case 921600: bdt = BAUD921600; break;
					#endif
				}

				PortSettings settings;
				settings.BaudRate = bdt;
				settings.DataBits = DATA_8;
				settings.Parity = PAR_NONE;
				settings.StopBits = STOP_1;
				settings.FlowControl = FLOW_OFF;
				settings.Timeout_Millisec = 1000;
//				settings.setQueryMode(QextSerialBase::EventDriven);

//				QextSerialPort *serial_dev = new QextSerialPort(str, settings, QextSerialPort::Polling);
//				QextSerialPort *serial_dev = new QextSerialPort(str, settings, QextSerialPort::EventDriven);
				QextSerialPort *serial_dev = new QextSerialPort(str, settings);
				if (!serial_dev)
					break;

//				if (!serial_dev->open(QIODevice::ReadWrite | QIODevice::Unbuffered))
				if (!serial_dev->open(QIODevice::ReadWrite))
				{
					delete serial_dev;
					break;
				}

				m_ioDevice = serial_dev;
				break;
			}

		case USB_PORT:	// USB port
			{
				RawHID *usb_dev = new RawHID(device_str);
				if (!usb_dev)
					break;

//				if (!usb_dev->open(QIODevice::ReadWrite | QIODevice::Unbuffered))
				if (!usb_dev->open(QIODevice::ReadWrite))
				{
					delete usb_dev;
					break;
				}

				m_ioDevice = usb_dev;
				break;
			}

		default:	// unknown port type
			break;
	}

	if (!m_ioDevice)
	{	// failed to connect .. restore GCS telemetry and polling
		enableTelemetry();
	}
	else
	{	// connected OK
		memset(&pipx_config_details, 0, sizeof(pipx_config_details));
		memset(&pipx_config_settings, 0, sizeof(pipx_config_settings));

		m_widget->connectButton->setText("Disconnect");
		m_widget->comboBox_SerialBaudrate->setEnabled(false);
		m_widget->comboBox_Ports->setEnabled(false);
		m_widget->refreshPorts->setEnabled(false);

		m_ioDevice->setTextModeEnabled(false);
		QTimer::singleShot(100, this, SLOT(processRxStream()));
//		connect(m_ioDevice, SIGNAL(readyRead()), this, SLOT(processRxStream()));

		m_stage_retries = 0;
		m_stage = PIPX_REQ_DETAILS;
		QTimer::singleShot(100, this, SLOT(processStream()));
	}
}

// ***************************************************************************************

void PipXtremeGadgetWidget::connectDisconnect()
{
	if (m_ioDevice)
		disconnectPort(true);	// disconnect
	else
		connectPort();			// connect
}

// ***************************************************************************************
// Shows a message box with an error string.

void PipXtremeGadgetWidget::error(QString errorString, int errorNumber)
{
    QMessageBox msgBox;
    msgBox.setIcon(QMessageBox::Critical);
    msgBox.setText(errorString + " [" + QString::number(errorNumber) + "]");
    msgBox.exec();
}

// ***************************************************************************************