/**
******************************************************************************
*
* @file       configtxpidswidget.cpp
* @author     The OpenPilot Team, http://www.openpilot.org Copyright (C) 2012.
* @addtogroup GCSPlugins GCS Plugins
* @{
* @addtogroup ConfigPlugin Config Plugin
* @{
* @brief The Configuration Gadget used to configure the PipXtreme
*****************************************************************************/
/*
 * 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 "configpipxtremewidget.h"

#include <oplinksettings.h>
#include <oplinkstatus.h>

ConfigPipXtremeWidget::ConfigPipXtremeWidget(QWidget *parent) : ConfigTaskWidget(parent)
{
	m_oplink = new Ui_PipXtremeWidget();
	m_oplink->setupUi(this);

	// Connect to the OPLinkStatus object updates
	ExtensionSystem::PluginManager *pm = ExtensionSystem::PluginManager::instance();
	UAVObjectManager *objManager = pm->getObject<UAVObjectManager>();
	oplinkStatusObj = dynamic_cast<UAVDataObject*>(objManager->getObject("OPLinkStatus"));
	if (oplinkStatusObj != NULL ) {
		connect(oplinkStatusObj, SIGNAL(objectUpdated(UAVObject*)), this, SLOT(updateStatus(UAVObject*)));
	} else {
		qDebug() << "Error: Object is unknown (OPLinkStatus).";
	}

	// Connect to the OPLinkSettings object updates
	oplinkSettingsObj = dynamic_cast<OPLinkSettings*>(objManager->getObject("OPLinkSettings"));
	if (oplinkSettingsObj != NULL ) {
		connect(oplinkSettingsObj, SIGNAL(objectUpdated(UAVObject*)), this, SLOT(updateSettings(UAVObject*)));
	} else {
		qDebug() << "Error: Object is unknown (OPLinkSettings).";
	}
	autoLoadWidgets();
	addApplySaveButtons(m_oplink->Apply, m_oplink->Save);

	addUAVObjectToWidgetRelation("OPLinkSettings", "UAVTalk", m_oplink->UAVTalk);
	addUAVObjectToWidgetRelation("OPLinkSettings", "PPM", m_oplink->PPM);
	addUAVObjectToWidgetRelation("OPLinkSettings", "InputConnection", m_oplink->InputConnection);
	addUAVObjectToWidgetRelation("OPLinkSettings", "OutputConnection", m_oplink->OutputConnection);
	addUAVObjectToWidgetRelation("OPLinkSettings", "ComSpeed", m_oplink->ComSpeed);
	addUAVObjectToWidgetRelation("OPLinkSettings", "MaxRFPower", m_oplink->MaxRFTxPower);
	addUAVObjectToWidgetRelation("OPLinkSettings", "SendTimeout", m_oplink->SendTimeout);
	addUAVObjectToWidgetRelation("OPLinkSettings", "MinPacketSize", m_oplink->MinPacketSize);
	addUAVObjectToWidgetRelation("OPLinkSettings", "FrequencyCalibration", m_oplink->FrequencyCalibration);
	addUAVObjectToWidgetRelation("OPLinkSettings", "MinFrequency", m_oplink->MinFrequency);
	addUAVObjectToWidgetRelation("OPLinkSettings", "MaxFrequency", m_oplink->MaxFrequency);

	addUAVObjectToWidgetRelation("OPLinkStatus", "RxGood", m_oplink->Good);
	addUAVObjectToWidgetRelation("OPLinkStatus", "RxCorrected", m_oplink->Corrected);
	addUAVObjectToWidgetRelation("OPLinkStatus", "RxErrors", m_oplink->Errors);
	addUAVObjectToWidgetRelation("OPLinkStatus", "RxMissed", m_oplink->Missed);
	addUAVObjectToWidgetRelation("OPLinkStatus", "RxFailure", m_oplink->RxFailure);
	addUAVObjectToWidgetRelation("OPLinkStatus", "UAVTalkErrors", m_oplink->UAVTalkErrors);
	addUAVObjectToWidgetRelation("OPLinkStatus", "TxDropped", m_oplink->Dropped);
	addUAVObjectToWidgetRelation("OPLinkStatus", "TxResent", m_oplink->Resent);
	addUAVObjectToWidgetRelation("OPLinkStatus", "TxFailure", m_oplink->TxFailure);
	addUAVObjectToWidgetRelation("OPLinkStatus", "Resets", m_oplink->Resets);
	addUAVObjectToWidgetRelation("OPLinkStatus", "Timeouts", m_oplink->Timeouts);
	addUAVObjectToWidgetRelation("OPLinkStatus", "RSSI", m_oplink->RSSI);
	addUAVObjectToWidgetRelation("OPLinkStatus", "AFCCorrection", m_oplink->AFCCorrection);
	addUAVObjectToWidgetRelation("OPLinkStatus", "LinkQuality", m_oplink->LinkQuality);
	addUAVObjectToWidgetRelation("OPLinkStatus", "RXSeq", m_oplink->RXSeq);
	addUAVObjectToWidgetRelation("OPLinkStatus", "TXSeq", m_oplink->TXSeq);
	addUAVObjectToWidgetRelation("OPLinkStatus", "RXRate", m_oplink->RXRate);
	addUAVObjectToWidgetRelation("OPLinkStatus", "TXRate", m_oplink->TXRate);

	// Connect to the pair ID radio buttons.
	connect(m_oplink->PairSelect1, SIGNAL(toggled(bool)), this, SLOT(pairIDToggled(bool)));
	connect(m_oplink->PairSelect2, SIGNAL(toggled(bool)), this, SLOT(pairIDToggled(bool)));
	connect(m_oplink->PairSelect3, SIGNAL(toggled(bool)), this, SLOT(pairIDToggled(bool)));
	connect(m_oplink->PairSelect4, SIGNAL(toggled(bool)), this, SLOT(pairIDToggled(bool)));

	// Connect to the binding buttons.
	connect(m_oplink->BindingAdd, SIGNAL(pressed()), this, SLOT(addBinding()));
	connect(m_oplink->BindingRemove, SIGNAL(pressed()), this, SLOT(removeBinding()));
	m_oplink->BindingAdd->setEnabled(false);
	m_oplink->BindingRemove->setEnabled(false);

	// Connect to changes to the bindings widgets.
	connect(m_oplink->Bindings, SIGNAL(itemSelectionChanged()), this, SLOT(bindingsSelectionChanged()));

	//Add scroll bar when necessary
	QScrollArea *scroll = new QScrollArea;
	scroll->setWidget(m_oplink->frame_3);
	scroll->setWidgetResizable(true);
	m_oplink->verticalLayout_3->addWidget(scroll);

	// Request and update of the setting object.
	settingsUpdated = false;

	disableMouseWheelEvents();
}

ConfigPipXtremeWidget::~ConfigPipXtremeWidget()
{
	// Do nothing
}

void ConfigPipXtremeWidget::refreshValues()
{
}

void ConfigPipXtremeWidget::applySettings()
{
	OPLinkSettings *oplinkSettings = OPLinkSettings::GetInstance(getObjectManager());
	OPLinkSettings::DataFields oplinkSettingsData = oplinkSettings->getData();

	// Get the pair ID.
	quint32 pairID = 0;
	bool okay;
	if (m_oplink->PairSelect1->isChecked())
		pairID = m_oplink->PairID1->text().toUInt(&okay, 16);
	else if (m_oplink->PairSelect2->isChecked())
		pairID = m_oplink->PairID2->text().toUInt(&okay, 16);
	else if (m_oplink->PairSelect3->isChecked())
		pairID = m_oplink->PairID3->text().toUInt(&okay, 16);
	else if (m_oplink->PairSelect4->isChecked())
		pairID = m_oplink->PairID4->text().toUInt(&okay, 16);
	oplinkSettings->setData(oplinkSettingsData);
}

void ConfigPipXtremeWidget::saveSettings()
{
	//applySettings();
	UAVObject *obj = OPLinkSettings::GetInstance(getObjectManager());
	saveObjectToSD(obj);
}

/*!
  \brief Called by updates to @OPLinkStatus
  */
void ConfigPipXtremeWidget::updateStatus(UAVObject *object)
{

	// Request and update of the setting object if we haven't received it yet.
	if (!settingsUpdated)
		oplinkSettingsObj->requestUpdate();

	// Get the current pairID
	//OPLinkSettings *oplinkSettings = OPLinkSettings::GetInstance(getObjectManager());
	quint32 pairID = 0;

	// Update the detected devices.
	UAVObjectField* pairIdField = object->getField("PairIDs");
	if (pairIdField) {
		quint32 pairid1 = pairIdField->getValue(0).toUInt();
		m_oplink->PairID1->setText(QString::number(pairid1, 16).toUpper());
		m_oplink->PairID1->setEnabled(false);
		m_oplink->PairSelect1->setChecked(pairID && (pairID == pairid1));
		m_oplink->PairSelect1->setEnabled(pairid1);
		quint32 pairid2 = pairIdField->getValue(1).toUInt();
		m_oplink->PairID2->setText(QString::number(pairIdField->getValue(1).toUInt(), 16).toUpper());
		m_oplink->PairID2->setEnabled(false);
		m_oplink->PairSelect2->setChecked(pairID && (pairID == pairid2));
		m_oplink->PairSelect2->setEnabled(pairid2);
		quint32 pairid3 = pairIdField->getValue(2).toUInt();
		m_oplink->PairID3->setText(QString::number(pairIdField->getValue(2).toUInt(), 16).toUpper());
		m_oplink->PairID3->setEnabled(false);
		m_oplink->PairSelect3->setChecked(pairID && (pairID == pairid3));
		m_oplink->PairSelect3->setEnabled(pairid3);
		quint32 pairid4 = pairIdField->getValue(3).toUInt();
		m_oplink->PairID4->setText(QString::number(pairIdField->getValue(3).toUInt(), 16).toUpper());
		m_oplink->PairID4->setEnabled(false);
		m_oplink->PairSelect4->setChecked(pairID && (pairID == pairid4));
		m_oplink->PairSelect4->setEnabled(pairid4);
	} else {
		qDebug() << "PipXtremeGadgetWidget: Count not read PairID field.";
	}
	UAVObjectField* pairRssiField = object->getField("PairSignalStrengths");
	if (pairRssiField) {
		m_oplink->PairSignalStrengthBar1->setValue(pairRssiField->getValue(0).toInt());
		m_oplink->PairSignalStrengthBar2->setValue(pairRssiField->getValue(1).toInt());
		m_oplink->PairSignalStrengthBar3->setValue(pairRssiField->getValue(2).toInt());
		m_oplink->PairSignalStrengthBar4->setValue(pairRssiField->getValue(3).toInt());
		m_oplink->PairSignalStrengthLabel1->setText(QString("%1dB").arg(pairRssiField->getValue(0).toInt()));
		m_oplink->PairSignalStrengthLabel2->setText(QString("%1dB").arg(pairRssiField->getValue(1).toInt()));
		m_oplink->PairSignalStrengthLabel3->setText(QString("%1dB").arg(pairRssiField->getValue(2).toInt()));
		m_oplink->PairSignalStrengthLabel4->setText(QString("%1dB").arg(pairRssiField->getValue(3).toInt()));
	} else {
		qDebug() << "PipXtremeGadgetWidget: Count not read PairID field.";
	}

	// Update the Description field
	UAVObjectField* descField = object->getField("Description");
	if (descField) {
		/*
		 * This looks like a binary with a description at the end
		 *  4 bytes: header: "OpFw"
		 *  4 bytes: git commit hash (short version of SHA1)
		 *  4 bytes: Unix timestamp of last git commit
		 *  2 bytes: target platform. Should follow same rule as BOARD_TYPE and BOARD_REVISION in board define files.
		 *  26 bytes: commit tag if it is there, otherwise "Unreleased". Zero-padded
		 *   ---- 40 bytes limit ---
		 *  20 bytes: SHA1 sum of the firmware.
		 *  40 bytes: free for now.
		 */
		char buf[OPLinkStatus::DESCRIPTION_NUMELEM];
		for (unsigned int i = 0; i < 26; ++i)
			buf[i] = descField->getValue(i + 14).toChar().toAscii();
		buf[26] = '\0';
		QString descstr(buf);
		quint32 gitDate = descField->getValue(11).toChar().toAscii() & 0xFF;
		for (int i = 1; i < 4; i++) {
			gitDate = gitDate << 8;
			gitDate += descField->getValue(11-i).toChar().toAscii() & 0xFF;
		}
		QString date = QDateTime::fromTime_t(gitDate).toUTC().toString("yyyy-MM-dd HH:mm");
		m_oplink->FirmwareVersion->setText(descstr + " " + date);
 	} else {
 		qDebug() << "PipXtremeGadgetWidget: Count not read Description field.";
 	}

	// Update the serial number field
	UAVObjectField* serialField = object->getField("CPUSerial");
	if (serialField) {
		char buf[OPLinkStatus::CPUSERIAL_NUMELEM * 2 + 1];
		for (unsigned int i = 0; i < OPLinkStatus::CPUSERIAL_NUMELEM; ++i)
		{
			unsigned char val = serialField->getValue(i).toUInt() >> 4;
			buf[i * 2] = ((val < 10) ? '0' : '7') + val;
			val = serialField->getValue(i).toUInt() & 0xf;
			buf[i * 2 + 1] = ((val < 10) ? '0' : '7') + val;
		}
		buf[OPLinkStatus::CPUSERIAL_NUMELEM * 2] = '\0';
		m_oplink->SerialNumber->setText(buf);
 	} else {
 		qDebug() << "PipXtremeGadgetWidget: Count not read Description field.";
 	}

	// Update the DeviceID field
	UAVObjectField* idField = object->getField("DeviceID");
	if (idField) {
		m_oplink->DeviceID->setText(QString::number(idField->getValue().toUInt(), 16).toUpper());
	} else {
		qDebug() << "PipXtremeGadgetWidget: Count not read DeviceID field.";
	}

 	// Update the link state
 	UAVObjectField* linkField = object->getField("LinkState");
 	if (linkField) {
		m_oplink->LinkState->setText(linkField->getValue().toString());
	} else {
		qDebug() << "PipXtremeGadgetWidget: Count not read link state field.";
	}
}

/*!
  \brief Called by updates to @OPLinkSettings
  */
void ConfigPipXtremeWidget::updateSettings(UAVObject *object)
{
	Q_UNUSED(object);

	if (!settingsUpdated)
	{
		settingsUpdated = true;
		enableControls(true);

		// Refresh the list widget.
		refreshBindingsList();
	}
}

void ConfigPipXtremeWidget::disconnected()
{
	if (settingsUpdated)
	{
		settingsUpdated = false;
		enableControls(false);
	}
}

void ConfigPipXtremeWidget::pairIDToggled(bool checked)
{
	bool enabled = (m_oplink->PairSelect1->isChecked() || m_oplink->PairSelect2->isChecked() || m_oplink->PairSelect3->isChecked() || m_oplink->PairSelect4->isChecked());
	m_oplink->BindingAdd->setEnabled(enabled);
}

void ConfigPipXtremeWidget::bindingsSelectionChanged()
{
	bool enabled = (m_oplink->Bindings->selectedItems().size() > 0);
	m_oplink->BindingRemove->setEnabled(enabled);
}

void ConfigPipXtremeWidget::refreshBindingsList()
{
	m_oplink->Bindings->clear();
	for (quint32 slot = 0; slot < OPLinkSettings::BINDINGS_NUMELEM; ++slot)
	{
		quint32 id = oplinkSettingsObj->getBindings(slot);
		if (id != 0)
			m_oplink->Bindings->addItem(QString::number(id, 16).toUpper());
	}
}

void ConfigPipXtremeWidget::addBinding()
{

	// Get the pair ID out of the selection widget
	quint32 pairID = 0;
	bool okay;
	if (m_oplink->PairSelect1->isChecked())
		pairID = m_oplink->PairID1->text().toUInt(&okay, 16);
	else if (m_oplink->PairSelect2->isChecked())
		pairID = m_oplink->PairID2->text().toUInt(&okay, 16);
	else if (m_oplink->PairSelect3->isChecked())
		pairID = m_oplink->PairID3->text().toUInt(&okay, 16);
	else if (m_oplink->PairSelect4->isChecked())
		pairID = m_oplink->PairID4->text().toUInt(&okay, 16);

	// Find a slot for this pair ID in the binding list.
	quint32 slot = 0;
	for ( ; slot < OPLinkSettings::BINDINGS_NUMELEM - 1; ++slot)
	{
		quint32 id = oplinkSettingsObj->getBindings(slot);

		// Is this ID already in the list?
		if (id == pairID)
			return;

		// Is this slot empty?
		if (id == 0)
			break;
	}

	// Store the ID in the first open slot (or the last slot if all are full).
	oplinkSettingsObj->setBindings(slot, pairID);

	// Refresh the list widget.
	refreshBindingsList();
}

void ConfigPipXtremeWidget::removeBinding()
{
	// Get the selected rows from the bindings list widget.
	QList<QListWidgetItem*> selected = m_oplink->Bindings->selectedItems();

	// Zero out the selected rows in the bindings list.
	for (int i = 0; i < selected.size(); ++i)
		oplinkSettingsObj->setBindings(m_oplink->Bindings->row(selected[i]), 0);

	// Refresh the list widget and compact the bindings list.
	m_oplink->Bindings->clear();
	quint32 outSlot = 0;
	for (quint32 slot = 0; slot < OPLinkSettings::BINDINGS_NUMELEM; ++slot)
	{
		quint32 id = oplinkSettingsObj->getBindings(slot);
		if (id != 0) {
			oplinkSettingsObj->setBindings(outSlot++, id);
			m_oplink->Bindings->addItem(QString::number(id, 16).toUpper());
		}
	}
	for ( ; outSlot < OPLinkSettings::BINDINGS_NUMELEM; ++outSlot)
		oplinkSettingsObj->setBindings(outSlot, 0);
}

/**
   @}
   @}
*/