// hyperion local includes
#include "LedDeviceKarate.h"

LedDeviceKarate::LedDeviceKarate(const QJsonObject &deviceConfig)
	: ProviderRs232()
{
	_devConfig = deviceConfig;
	_deviceReady = false;

	connect(this,SIGNAL(receivedData(QByteArray)),this,SLOT(receivedData(QByteArray)));
}

LedDevice* LedDeviceKarate::construct(const QJsonObject &deviceConfig)
{
	return new LedDeviceKarate(deviceConfig);
}

bool LedDeviceKarate::init(const QJsonObject &deviceConfig)
{
	bool isInitOK = ProviderRs232::init(deviceConfig);

	if ( isInitOK )
	{
		if (_ledCount != 16)
		{
			//Error( _log, "%d channels configured. This should always be 16!", _ledCount);
			QString errortext = QString ("%1 channels configured. This should always be 16!").arg(_ledCount);
			this->setInError(errortext);
			isInitOK = false;
		}
		else
		{

			_ledBuffer.resize(4 + _ledCount * 3); // 4-byte header, 3 RGB values
			_ledBuffer[0] = 0xAA;       // Startbyte
			_ledBuffer[1] = 0x12;       // Send all Channels in Batch
			_ledBuffer[2] = 0x00;       // Checksum
			_ledBuffer[3] = _ledCount * 3;       // Number of Databytes send

			Debug( _log, "Karatelight header for %d leds: 0x%02x 0x%02x 0x%02x 0x%02x", _ledCount,
				  _ledBuffer[0], _ledBuffer[1], _ledBuffer[2], _ledBuffer[3] );
		}
	}
	return isInitOK;
}

int LedDeviceKarate::write(const std::vector<ColorRgb> &ledValues)
{
	for (signed iLed=0; iLed<_ledCount; iLed++)
        {
		
       		const ColorRgb& rgb = ledValues[iLed];
                _ledBuffer[iLed*3+4] = rgb.green;
                _ledBuffer[iLed*3+5] = rgb.blue;
                _ledBuffer[iLed*3+6] = rgb.red;
        }

	// Calc Checksum
	_ledBuffer[2] =  _ledBuffer[0] ^ _ledBuffer[1];
    	for (unsigned int i = 3; i < _ledBuffer.size(); i++)
      		_ledBuffer[2] ^= _ledBuffer[i];

	return writeBytes(_ledBuffer.size(), _ledBuffer.data());
}

void LedDeviceKarate::receivedData(QByteArray data)
{
        Debug(_log, ">>received %d bytes data %s", data.size(),data.data());
}