#include "AbsFSController.h"
#include "ZZ_Math_HDRONLY.h"
CAbsFSController::CAbsFSController(QObject* parent /*= nullptr*/)
{
	m_iFlagInit = 0;
#ifdef _DEBUG
	m_qstrWaveLengthPath = "E:/WorkSpace/TowerOptoSifAndSpectral/Data/WaveLengthInfo.txt";
#else
	m_qstrWaveLengthPath = "/home/data/Data/WaveLengthInfo.txt";
#endif // DEBUG
}

CAbsFSController::~CAbsFSController()
{
}

void CAbsFSController::SetContext(OneFSContext struFSParam)
{
	m_struFSParam = struFSParam;
}

int CAbsFSController::Initialize()
{
	using namespace ZZ_MISCDEF::IRIS;

	m_iFlagInit = 0;

	switch (m_struFSParam.ucDeviceModel)
	{
	case DeviceModel::FLAME:
		m_pFSCtrl = new OceanOptics_lib;
		if (m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, m_struFSParam.strSN) != 0)
		{
			qDebug() << "Flame Not Opened";
			return 1;
		}
		break;
	case DeviceModel::OSIFAlpha:
		m_pFSCtrl = new OceanOptics_lib;
		if (m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, m_struFSParam.strSN) != 0)
		{
			qDebug() << "OSIFAlpha Not Opened";
			return 2;
		}
		break;
	case DeviceModel::OSIFBeta:
		m_pFSCtrl = new OceanOptics_lib;
		if (m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, m_struFSParam.strSN) != 0)
		{
			qDebug() << "OSIFBeta Not Opened";
			return 2;
		}
		break;
	case DeviceModel::ISIF:
		m_pFSCtrl = new ZZ_ATPControl_Serial_Qt;
		//m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, NULL);
		if (m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, m_struFSParam.strSN) != 0)
		{
			qDebug() << "ISIF Not Opened";
			return 3;
		}
		break;
	case DeviceModel::IS1:
		m_pFSCtrl = new ZZ_ATPControl_Serial_Qt;
		//m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, NULL);
		if (m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, m_struFSParam.strSN) != 0)
		{
			qDebug() << "IS1 Not Opened";
			return 3;
		}
		break;
	case DeviceModel::IS2:
		m_pFSCtrl = new ZZ_ATPControl_Serial_Qt;
		//m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, NULL);
		if (m_pFSCtrl->Initialize(false, m_struFSParam.strInterface, m_struFSParam.strSN) != 0)
		{
			qDebug() << "IS2 Not Opened";
			return 3;
		}
		break;
	default:
		break;
	}

	int iRes = m_pFSCtrl->GetDeviceAttribute(m_struDeviceAttr);
	if (iRes != 0)
	{
		qDebug() << "GetDeviceAttribute Failed" << iRes;
		return 4;
	}

	iRes = m_pFSCtrl->SetDeviceTemperature(0);
	if (iRes != 0)
	{
		qDebug() << "SetDeviceTemperature Failed" << iRes;
		//return 5;
	}
	m_iFlagInit = 1;
	return 0;
}

int CAbsFSController::Initialize_Self()
{
	return 0;
}

int CAbsFSController::SetExposureTime(int iMilliSec)
{
	return m_pFSCtrl->SetExposureTime(iMilliSec);
}

int CAbsFSController::GetExposureTime(int& iMilliSec)
{
	return m_pFSCtrl->GetExposureTime(iMilliSec);
}

int CAbsFSController::SingleShot(DataFrame& struSingleFrame)
{
	using namespace ZZ_MISCDEF::IRIS;

	


	int iRes = m_pFSCtrl->SingleShot(m_struSingleFrame);
	if (iRes != 0)
	{
		qDebug() << "Err. SingleShot";
		return 1;
	}

	if (m_struFSParam.ucDeviceModel == DeviceModel::FLAME)
	{
		int iRes = m_pFSCtrl->SingleShot(m_struSingleFrame);
		if (iRes != 0)
		{
			qDebug() << "Err. SingleShot";
			return 1;
		}
	}

	if (m_struFSParam.ucDeviceModel == DeviceModel::ISIF)
	{
		float fTemp;
		m_pFSCtrl->GetDeviceTemperature(fTemp);
		m_struSingleFrame.fTemperature = fTemp;
	}
	else if (m_struFSParam.ucDeviceModel == DeviceModel::IS2)
	{
		float fTemp;
		m_pFSCtrl->GetDeviceTemperature(fTemp);
		m_struSingleFrame.fTemperature = fTemp;
	}
	else if (m_struFSParam.ucDeviceModel == DeviceModel::IS1)
	{
		m_struSingleFrame.fTemperature = 1000;
	}
	else if (m_struFSParam.ucDeviceModel == DeviceModel::FLAME)
	{
		m_struSingleFrame.fTemperature = 1000;
	}

	QDateTime qdtTime = QDateTime::currentDateTime();
	m_struSingleFrame.dTimes = qdtTime.toMSecsSinceEpoch();

	struSingleFrame = m_struSingleFrame;
	return 0;
}

int CAbsFSController::PerformAutoExposure()
{

	qDebug() << "--------------------------Starting PerformAutoExposure";
	using namespace ZZ_MATH;
	float fPredictedExposureTime;
	int iDeviceDepth = (int)m_struFSParam.lDepth;

	qDebug() << "MAX---Min" << m_struFSParam.fMaxFactor << "---" << m_struFSParam.fMinFactor ;

	bool bFlagIsOverTrying = false;
	bool bFlagIsLowerMinExposureTime = false;
	bool bFlagIsOverMaxExposureTime = false;
	bool bFlagIsAutoExposureOK = false;
	bool bFlagIsAutoExposureFailed = false;

	bool bIsValueOverflow = false;
	bool bIsLastValueOverflow = false;

	int  iExposureTime = 0;
	float  fTempExposureTime = 0;
	double fLastExposureTime = 0.1;
	int    iRepeatCount = 0;


	while (!bFlagIsAutoExposureOK && !bFlagIsAutoExposureFailed)
	{
		DataFrame dfTemp;

		if (iRepeatCount++ > 30)
		{
			bFlagIsAutoExposureFailed = true;
			bFlagIsOverTrying = true;
			break;
		}

		m_pFSCtrl->GetExposureTime(iExposureTime);
		qDebug() << "Current ExpTime:" << iExposureTime;
		fTempExposureTime = iExposureTime;

		int iRes = m_pFSCtrl->SingleShot(dfTemp);
		if (iRes != 0)
		{
			qDebug() << "Err:PerformAutoExposure Failed.Exit Code:2";
			return 2;
		}

		HeapSort(dfTemp.lData, m_struDeviceAttr.iPixels);

		double dSum = 0;
		int iCount = m_struDeviceAttr.iPixels / 200;
		for (int i = 0; i < iCount; i++)
		{
			dSum += dfTemp.lData[i];
		}
		double dTemp = dSum / iCount;

		qDebug() << "Avg " << dTemp ;

		if (dTemp >= iDeviceDepth * 0.99)
		{
			bIsValueOverflow = true;
			if (!bIsLastValueOverflow)
			{
				iExposureTime = (float)(fLastExposureTime + iExposureTime) / 2;
			}
			else
			{
				iExposureTime = iExposureTime / 2;
			}
		}

		else if (iDeviceDepth * m_struFSParam.fMaxFactor >= dTemp && dTemp >= iDeviceDepth * m_struFSParam.fMinFactor)
		{
			qDebug() << "trace bFlagIsAutoExposureOK =1 " << iExposureTime;
			bFlagIsAutoExposureOK = 1;
		}
		else if (dTemp > iDeviceDepth * m_struFSParam.fMaxFactor)
		{
			bIsValueOverflow = true;
			if (!bIsLastValueOverflow)
			{
				iExposureTime = (float)(fLastExposureTime + iExposureTime) / 2;
			}
			else
			{
				iExposureTime = iExposureTime * 3 / 4;
			}
		}
		else if (dTemp < iDeviceDepth * m_struFSParam.fMinFactor)
		{
			bIsValueOverflow = false;
			if (bIsLastValueOverflow)
			{
				iExposureTime = (float)(fLastExposureTime + iExposureTime) / 2;
			}
			else
			{
				double dFactor;
				dFactor = dTemp / (iDeviceDepth * m_struFSParam.fMaxFactor);
				iExposureTime = (float)(iExposureTime / dFactor);
			}

		}
		bIsLastValueOverflow = bIsValueOverflow;
		fLastExposureTime = fTempExposureTime;



		if (iExposureTime <= m_struDeviceAttr.iMinIntegrationTimeInMS)
		{
			bFlagIsAutoExposureOK = false;
			bFlagIsAutoExposureFailed = true;
			bFlagIsLowerMinExposureTime = true;

			iRes = m_pFSCtrl->SetExposureTime(m_struDeviceAttr.iMinIntegrationTimeInMS);
			if (iRes != 0)
			{
				qDebug() << "Err:PerformAutoExposure Failed.Exit Code:3" ;
				return 3;
			}
			else
			{
				qDebug() << "Warning:PerformAutoExposure lower than min integration time.Will be limited to " << m_struDeviceAttr.iMinIntegrationTimeInMS << "MS";
			}

			break;
		}

		if (iExposureTime > m_struDeviceAttr.iMaxIntegrationTimeInMS - 1)
		{
			bFlagIsAutoExposureOK = false;
			bFlagIsAutoExposureFailed = true;
			bFlagIsOverMaxExposureTime = true;

			iRes = m_pFSCtrl->SetExposureTime(m_struDeviceAttr.iMaxIntegrationTimeInMS - 1);
			if (iRes != 0)
			{
				qDebug() << "Err:PerformAutoExposure Failed.Exit Code:3";
				return 3;
			}
			else
			{
				qDebug() << "Warning:PerformAutoExposure exceed max integration time.Will be limited to " << m_struDeviceAttr.iMaxIntegrationTimeInMS - 1 << "MS";
			}

			break;
		}

		iRes = m_pFSCtrl->SetExposureTime((int)iExposureTime);
		if (iRes != 0)
		{
			qDebug() << "Err:PerformAutoExposure Failed.Exit Code:4" ;
			return 3;
		}
		else
		{
			qDebug() << "Success:PerformAutoExposure. Value" << iExposureTime ;
		}
	}

	fPredictedExposureTime = iExposureTime;
	qDebug() << "--------------------------Stop PerformAutoExposure";

	return 0;
}

int CAbsFSController::CheckAndAdjust_Fast()
{
	using namespace ZZ_MATH;

	int iExposureTime = 0;

	int iRes = m_pFSCtrl->GetExposureTime(iExposureTime);
	if (iRes != 0)
	{
		qDebug() << "Err. SingleShot";
		return 1;
	}


	HeapSort(m_struSingleFrame.lData, m_struDeviceAttr.iPixels);

	double dSum = 0;
	int iCount = m_struDeviceAttr.iPixels / 200;
	for (int i = 0; i < iCount; i++)
	{
		dSum += m_struSingleFrame.lData[i];
	}
	double dTemp = dSum / iCount;


	if (dTemp >= m_struFSParam.lDepth * 0.99)
	{
		iExposureTime = iExposureTime / 2;
	}
	else
	{
		double dFactor;
		dFactor = dTemp / (float)(m_struFSParam.lDepth * m_struFSParam.fMaxFactor);
		iExposureTime = (float)(iExposureTime / dFactor);
	}

	return 0;
}

void CAbsFSController::GetDeviceAttr(DeviceAttribute& struDeviceAttr)
{
	struDeviceAttr = m_struDeviceAttr;
}

// int CAbsFSController::CreateWavelengthFile()
// {
// 	QDir qdirPath(qstrTemp);
// 	if (!qdirPath.exists())
// 	{
// 		bool bRes = qdirPath.mkdir(qstrTemp);
// 		if (!bRes)
// 		{
// 			qDebug() << "DataFileProcessor mkdir Failed.";
// 		}
// 	}
// 	m_qstrWaveLengthPath
// 	temp1 = "wavelength = ";
// 	file.Write(temp1, temp1.GetLength());
// 	file.Write("{", 1);
// 	return 0;
// }