#include "pch.h"
#include "M_AutoDiagnosisManager/DiagnosisProcessor.h"
#include "M_AutoDiagnosisManager/DiagnosisManager.h"
//#include "CHReviewSetting/SystemInfo.h"

#define M_PI       3.14159265358979323846
#define ToRadian(degree)	( (degree) * (M_PI/180.0) )
#define ToDegree(radian)	( (radian) * (180.0/M_PI) )

enum MotorOriginDirection { MotorOriginDir_LeftTop = 0, MotorOriginDir_RightTop, MotorOriginDir_LeftBottom, MotorOriginDir_RightBottom, MotorOriginDir_Count };

CDiagnosisProcessor::CDiagnosisProcessor()
{
	m_pDP2P = NULL;
	m_bStartProcess = FALSE;
}

CDiagnosisProcessor::~CDiagnosisProcessor()
{

}

BOOL CDiagnosisProcessor::StartProcess(int nProcessMode/* = 0*/)
{
	BOOL bRet = FALSE;

	CDiagnosisProcessData* pThreadData = new CDiagnosisProcessData(this);
	if (pThreadData)
	{
		pThreadData->nProcessMode = nProcessMode;
		bRet = CreateWorkThread(pThreadData);

		m_bStartProcess = bRet;
	}

	return bRet;
}

void CDiagnosisProcessor::StopProcess()
{
	m_bStartProcess = FALSE;

	int nSelModuleIndex = m_pDP2P->IDP2P_GetSelectedModuleIndex();
	m_pDP2P->IDP2P_SetAFMTracking(nSelModuleIndex, FALSE);
	//m_pDP2P->IDP2P_DiagnosisSendCompleteSig();
	CloseWorkThread();
}

void CDiagnosisProcessor::WorkThreadProcess(PVOID pParameter)
{
	if (pParameter == NULL) return;

	CString strMessage = "";

	CDiagnosisProcessData* pProcessData = static_cast<CDiagnosisProcessData*>(pParameter);
	int nProcessMode = pProcessData->nProcessMode;

	switch (nProcessMode)
	{
	case DiagnosisMode_All:
		//taek ProcessAll 일때와 아닐때를 구분하자
		m_pManager->m_bProcessAll = true;
		ProcessAll();
		break;
		//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
	case DiagnosisMode_Review :
		strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisMode_Review START"));
		m_pDP2P->IDP2P_DisplayMessage(0, strMessage);

		m_pManager->m_bProcessAll = false;
		if (IsCommandStop()) return;
		m_pDP2P->IDP2P_SetDialogTap(0);
		ProcessSquareness();
		Sleep(1000);
		if (IsCommandStop()) return;
		m_pDP2P->IDP2P_SetDialogTap(1);
		ProcessFlatness();
		Sleep(1000);

		if (ProcessDiagnosisJudge(nProcessMode) == FALSE) {
			strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisJudge FAIL"));
			m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
		}

		strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisMode_Review END"));
		m_pDP2P->IDP2P_DisplayMessage(0, strMessage);

		break;

	case DiagnosisMode_Wsi:
		strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisMode_WSI START"));
		m_pDP2P->IDP2P_DisplayMessage(0, strMessage);

		m_pManager->m_bProcessAll = false;
		if (IsCommandStop()) return;
		m_pDP2P->IDP2P_UpdateDialog(7);
		ProcessWsi();
		Sleep(1000);

		if (ProcessDiagnosisJudge(nProcessMode) == FALSE) {
			strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisJudge FAIL"));
			m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
		}

		strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisMode_WSI END"));
		m_pDP2P->IDP2P_DisplayMessage(0, strMessage);

		break;

	case DiagnosisMode_Squareness:
		m_pManager->m_bProcessAll = false;
		ProcessSquareness();
		Sleep(1000);
		if (ProcessDiagnosisJudge(nProcessMode) == FALSE) {
			strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisJudge FAIL"));
			m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
		}
		break;
		//#3514_LYW_CF AOI Review 자가진단 기능 개선_END
	case DiagnosisMode_Flatness:
		m_pManager->m_bProcessAll = false;
		ProcessFlatness();
		Sleep(1000);
		if (ProcessDiagnosisJudge(nProcessMode) == FALSE) {
			strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisJudge FAIL"));
			m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
		}
		break;

	case DiagnosisMode_Flatness_Manual:
		m_pManager->m_bProcessAll = false;
	//	ProcessFlatness_Manual();
		break;

	case DiagnosisMode_Simulation:
		m_pManager->m_bProcessAll = false;
	//	ProcessSimulation();
		break;

	}

	//m_pManager->SaveDiagnosisFile();
}

int CDiagnosisProcessor::ProcessAll()
{
	if (IsCommandStop()) return 1;

	CString strMessage = "";
	
	m_pDP2P->IDP2P_UpdateDialog(7);//WSI Result 칸 초기화 
	//if (m_pDP2P == NULL) return 0;

	m_pDP2P->IDP2P_SetDialogTap(0);
	ProcessSquareness();

	Sleep(1000);
	if (IsCommandStop()) return 1;

	if ( m_pManager->GetDiagnosisInfo()->GetPanelCount_Wsi() > 0)
	{
		m_pDP2P->IDP2P_SetDialogTap(2);
	ProcessWsi();
		Sleep(1000);
		if (IsCommandStop()) return 1;
	}
	m_pDP2P->IDP2P_SetDialogTap(1);
    ProcessFlatness();

	//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
	//Sleep(2000);
	Sleep(1000);

	if (ProcessDiagnosisJudge(DiagnosisMode_All) == FALSE) {
		strMessage.Format(_T("[CDiagnosisProcessor] DiagnosisJudge FAIL"));
		m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
	}
	//#3514_LYW_CF AOI Review 자가진단 기능 개선_START

	m_pManager->m_bProcessAll = false;

	return 1;
}

int CDiagnosisProcessor::ProcessSquareness()
{
	m_pDP2P->IDP2P_UpdateDialog(3);
	if (m_pDP2P == NULL || m_pManager == NULL) return 0;
	int nResultCount = 0;
	for(int i=0; i<2;i++)
	{ 


	 CDiagnosisInfo* pSettingInfo = m_pManager->GetDiagnosisInfo();
	 if (pSettingInfo == NULL) { 
		 m_pDP2P->IDP2P_UpdateDialog(4);
		 return 0; }

	//int nSelModuleIndex = m_pDP2P->IDP2P_GetSelectedModuleIndex();
	int nSelModuleIndex = i;

	int nPanelCount = pSettingInfo->GetPanelCount_Squareness();
	 CDiagnosisResult* pSettingResult = pSettingInfo->GetSettingResult_Squareness(nSelModuleIndex);
	 if (pSettingResult == NULL) {
		 m_pDP2P->IDP2P_UpdateDialog(4);
		 return 0;
	 }

	CDiagnosisResult* pProcessResult = m_pManager->GetDiagnosisResult_Squareness(nSelModuleIndex);
	if (pProcessResult == NULL) {
		m_pDP2P->IDP2P_UpdateDialog(4);
		return 0;
	}

	DWORD dwTime = GetTickCount(), dwTimeMotionEnd = 0;
	CString strMessage = _T("");

	if (nSelModuleIndex == 0)
	{
		m_pDP2P->IDP2P_MotorGo(1, 300, 400);

		if (m_pDP2P->IDP2P_GetMotionEnd(1) == FALSE)
		{
			m_pDP2P->IDP2P_UpdateDialog(4);
			return FALSE;
		}
	}
	else
	{
		m_pDP2P->IDP2P_MotorGo(0, 300, 400);

		if (m_pDP2P->IDP2P_GetMotionEnd(0) == FALSE)
		{
			m_pDP2P->IDP2P_UpdateDialog(4);
			return FALSE;
		}
	}

	pProcessResult->SetPanelCount_Squareness(nPanelCount);
	double dPosX = 0, dPosY = 0;
	int nIndex = 0;
	for (int nIdx=0; nIdx<nPanelCount; nIdx++)
	{
		if (IsCommandStop())
		{
			m_pDP2P->IDP2P_UpdateDialog(4);
			return 1;
		}

		SPositionData* pSettingPoint = pSettingResult->GetPositionData_Squareness(nIdx);
		if (pSettingPoint == NULL) continue;

		if (nSelModuleIndex == 0)
		{
			if (nIdx == 0)
			{
				pSettingPoint->dPosX = pSettingInfo->GetReviewPanelPosX();//1039.367;
				pSettingPoint->dPosY = pSettingInfo->GetReviewPanelPosY();// 258.97;
				}
			else if (nIdx == 1)
			{
					pSettingPoint->dPosX = pSettingInfo->GetReviewPanelPosX3(); // 1039.383;
					pSettingPoint->dPosY = pSettingInfo->GetReviewPanelPosY3(); // 2562.295;
			}
			else if (nIdx == 2)
			{
					pSettingPoint->dPosX = pSettingInfo->GetReviewPanelPosX5(); // 1039.367 + a;
					pSettingPoint->dPosY = pSettingInfo->GetReviewPanelPosY5(); // 258.97;
			}
		}
		else
		{
			if (nIdx == 0)
			{
				pSettingPoint->dPosX = pSettingInfo->GetReviewPanelPosX2();// 1704.449;
				pSettingPoint->dPosY = pSettingInfo->GetReviewPanelPosY2();// 59.723;
			}
				else if (nIdx == 1)
				{
					pSettingPoint->dPosX = pSettingInfo->GetReviewPanelPosX4(); // 1704.407;
					pSettingPoint->dPosY = pSettingInfo->GetReviewPanelPosY4(); // 2363.057;
				}
				else if (nIdx == 2)
			{
					pSettingPoint->dPosX = pSettingInfo->GetReviewPanelPosX6(); // 1704.449 + a;
					pSettingPoint->dPosY = pSettingInfo->GetReviewPanelPosY6(); // 59.723;
			}
		
		}
	
		// move panel
		m_pDP2P->IDP2P_MotorGo(nSelModuleIndex, pSettingPoint->dPosX, pSettingPoint->dPosY);

		if (m_pDP2P->IDP2P_GetMotionEnd(nSelModuleIndex) == FALSE) continue;

		
	   
		

		int stTime = GetTickCount();
		while (1)
		{
			//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
			//if (11000 <= GetTickCount() - stTime)
			//#3514_LYW_CF AOI Review 자가진단 기능 개선_END
			if (1500 <= GetTickCount() - stTime)
			{
				break;
			}


		}
		m_pDP2P->IDP2P_SetAFMTracking(nSelModuleIndex, TRUE);
		//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
		//Sleep(1000);
		Sleep(1000);
		//#3514_LYW_CF AOI Review 자가진단 기능 개선_END

		CString strimagename;
		strimagename.Format(_T("%s_Module[%d]Index[%d].bmp"), m_pManager->m_strResultImageFileName, nSelModuleIndex, nIdx);


		// find mark at panel
		double dFindPixX = 0., dFindPixY = 0.;
		if (m_pDP2P->IDP2P_FindPanelCenter(nSelModuleIndex, dFindPixX, dFindPixY, strimagename) == FALSE) {
			strMessage.Format(_T("[CDiagnosisProcessor] find mark at panel FAIL"));
			m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
			continue;
		}

		m_pDP2P->IDP2P_SetAFMTracking(nSelModuleIndex, FALSE);

		stTime = GetTickCount();
		while (1)
		{
			if (1000 <= GetTickCount() - stTime)
			{
				break;
			}
		}



		if (nSelModuleIndex == 1)
		{
			nResultCount = nIdx + 3;
		}
		else
		{
			nResultCount = nIdx;
		}

		// set result
		SPositionData* pResultPoint = pProcessResult->GetPositionData_Squareness(nResultCount);
		if (pResultPoint == NULL) continue;

		pResultPoint->nIndex = nResultCount;
		pResultPoint->nPosMode = nIdx;
		pResultPoint->nModuleIdx = nSelModuleIndex;
		pResultPoint->bProcsss = TRUE;
		pResultPoint->dPixelX = dFindPixX;
		pResultPoint->dPixelY = dFindPixY;
		pResultPoint->dPosX = pSettingPoint->dPosX;
		pResultPoint->dPosY = pSettingPoint->dPosY;

		nResultCount += 1;

		m_pDP2P->IDP2P_UpdateDialog(0);		// update calc theta
	}

	// calc gantry squareness
	CalculateSquareness(nSelModuleIndex);
	//if (CalculateSquareness() == FALSE) return FALSE;

	strMessage.Format(_T("[AutoDiagnosisProcessor] ProcessSquareness Time [%d]ms"), GetTickCount() - dwTime);
	m_pDP2P->IDP2P_DisplayMessage(0, strMessage);

	// make history data
	m_pManager->SaveDiangosisHistory_Squareness(); //taek 측정 히스토리 남긴다

	m_pManager->SaveDiagnosisFile_Squareness();

	m_pDP2P->IDP2P_UpdateDialog(0);		// update calc theta
	
	if (nSelModuleIndex == 1)
	{
		m_pDP2P->IDP2P_MotorGo(1, 300, 400);

		if (m_pDP2P->IDP2P_GetMotionEnd(1) == FALSE)
		{
			m_pDP2P->IDP2P_UpdateDialog(4);
			return FALSE;
		}
	}

	}
	m_pDP2P->IDP2P_UpdateDialog(4);
	return TRUE;
}

int CDiagnosisProcessor::ProcessWsi()
{
	m_pDP2P->IDP2P_UpdateDialog(5); //버튼 끄기
	if (m_pDP2P == NULL || m_pManager == NULL) return 0;

	const CDiagnosisInfo* pSettingInfo = m_pManager->GetDiagnosisInfo();
	if (pSettingInfo == NULL) {
		m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
		return 0;
	}
	int nSelModuleIndex = -1;

	int nPanelCount = pSettingInfo->GetPanelCount_Wsi();
	double dXpos = 0;
	double dYpos = 0;

	for (int i = 0; i < nPanelCount; i++)
	{
		nSelModuleIndex  = i;
		m_pManager->setWSIVLSIEnd(FALSE);
		if (nSelModuleIndex == -1)
		{
			m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
			return FALSE; 
		}

		if (nSelModuleIndex == 0)
		{
			m_pDP2P->IDP2P_MotorGo(1, 300, 400);

			if (m_pDP2P->IDP2P_IsGantryMotionEnd(1) == FALSE)
			{
				m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
				return FALSE;
			}

			dXpos = pSettingInfo->GetPanelPosX_Wsi();
			dYpos = pSettingInfo->GetPanelPosY_Wsi();

		}
		else
		{
			m_pDP2P->IDP2P_MotorGo(0, 300, 400);

			if (m_pDP2P->IDP2P_IsGantryMotionEnd(0) == FALSE)
			{
				m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
				return FALSE;
			}
			dXpos = pSettingInfo->GetPanelPosX2_Wsi();
			dYpos = pSettingInfo->GetPanelPosY2_Wsi();
		}

		DWORD dwTime = GetTickCount(), dwTimeMotionEnd = 0;
		CString strMessage = _T("");


		if (IsCommandStop())
		{
			m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
			return 1;
		}
		m_pDP2P->IDP2P_SetWsiManualMeasure(nSelModuleIndex, dXpos, dYpos);
		// move panel
		//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
		//Sleep(2000);
		Sleep(1000);
		//#3514_LYW_CF AOI Review 자가진단 기능 개선_END
		m_pDP2P->IDP2P_MotorGo(nSelModuleIndex, dXpos, dYpos);

		if (m_pDP2P->IDP2P_IsGantryMotionEnd(nSelModuleIndex) == FALSE)
		{
			m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
			return FALSE;
		}

		int stTime = GetTickCount();
		while (1)
		{
			//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
			//if (10000 <= GetTickCount() - stTime)
			if (11000 <= GetTickCount() - stTime)
			//#3514_LYW_CF AOI Review 자가진단 기능 개선_END
			{
				break;
			}


		}

		m_pDP2P->IDP2P_WsiMotorMotionEnd(nSelModuleIndex, dXpos, dYpos);

		int tickcount = GetTickCount();
		while (1)
		{
			Sleep(50);
		

			if (m_pManager->getWSIVLSIEnd() == true)
			{
				strMessage.Format(_T("[AutoDiagnosisProcessor] WSI VLSI END"));

				if (nSelModuleIndex == 1)
				{
					m_pDP2P->IDP2P_MotorGo(1, 300, 400);

					if (m_pDP2P->IDP2P_IsGantryMotionEnd(1) == FALSE)
					{
						m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
						return FALSE;
					}
				}

				// make history data
				m_pManager->SaveDiangosisHistory_Wsi(); //taek 측정 히스토리 남긴다

				//taek 종료 되기 전에 save
				m_pManager->SaveDiagnosisFile_Wsi();

				break;
			}

			if (30000 <= (GetTickCount() - tickcount))
			{

				strMessage.Format(_T("[AutoDiagnosisProcessor] WSI VLSI OVER TIME"));
				m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
				m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
				return FALSE;
			}
		}
		//}
	}

	
	m_pDP2P->IDP2P_UpdateDialog(6); //버튼 켜기
	return TRUE;
}

int CDiagnosisProcessor::ProcessFlatness()
{
	if (m_pDP2P == NULL || m_pManager == NULL) return 0;

	CString strMessage = "";

	CDiagnosisInfo * pSettingInfo = m_pManager->GetDiagnosisInfo();
	if (pSettingInfo == NULL) return 0;
	//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
	if (pSettingInfo->GetFlastnessSkipMode() == TRUE) {
		strMessage.Format(_T("[CDiagnosisProcessor] FlastnessSkipMode!"));
		m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
		return 0;
	}

	//#3514_LYW_CF AOI Review 자가진단 기능 개선_END

	int nSelModuleIndex = m_pDP2P->IDP2P_GetSelectedModuleIndex();
	int nFlatnessMode = pSettingInfo->GetFlatnessMode();
	int nTotalCount = pSettingInfo->GetRangeCount_Flatness();
	
	CDiagnosisResult * pProcessResult = m_pManager->GetDiagnosisResult_Flatness();
	if (pProcessResult == NULL) return 0;
	
	pProcessResult->SetRangeCount_Flatness(nTotalCount);
	pProcessResult->SetFlatnessMode(nFlatnessMode);
	pProcessResult->SetPositionData_Flatness(nTotalCount);

	SPositionData * pResultPoint = pProcessResult->GetPositionData_Flatness(0);
	if (pResultPoint == NULL) return 0;

	int nGlassSizeX = pSettingInfo->GetGlassSizeX_Flatness();
	int nGlassSizeY = pSettingInfo->GetGlassSizeY_Flatness();

	int nAFDelay = pSettingInfo->GetAFDelay();

	pProcessResult->PathScheduling_Flatness(pResultPoint, nGlassSizeX, nGlassSizeY);

	m_pDP2P->IDP2P_MotorGo(1, 0, 0);

	if (m_pDP2P->IDP2P_IsGantryMotionEnd(1) == FALSE)
	{
		return FALSE;
	}

	for (int nIdx = 0; nIdx < nTotalCount; nIdx++)
	{
		if (IsCommandStop()) return 1;
		double dZpos = 0.;



		if (nIdx == 0)	// if 1st point, afm tracking on
		{
			// AF Home
			m_pDP2P->IDP2P_AFMHomePosition(0);
			//#3514_LYW_CF AOI Review 자가진단 기능 개선_START
			//Sleep(5000);
			Sleep(1000);
			//#3514_LYW_CF AOI Review 자가진단 기능 개선_END
			m_pDP2P->IDP2P_SetAFMTracking(0, TRUE);
			Sleep(500);
		}

// 		if (nIdx == 0)
// 		{
// 			pResultPoint[nIdx].dPosX = 657.425
// 				;
// 			pResultPoint[nIdx].dPosY = 540.14
// 				;
// 		}
// 		else if (nIdx == 1)
// 		{
// 			pResultPoint[nIdx].dPosX = 657.425
// 				;
// 			pResultPoint[nIdx].dPosY = 2278.636
// 				;
// 		}
// 		else if (nIdx == 2)
// 		{
// 			pResultPoint[nIdx].dPosX = 2096.944
// 				;
// 			pResultPoint[nIdx].dPosY = 540.141
// 				;
// 		}
// 		else if (nIdx == 3)
// 		{
// 			pResultPoint[nIdx].dPosX = 2096.944
// 				;
// 			pResultPoint[nIdx].dPosY = 2278.636;
// 		}


		//1. 모터를 이동
		m_pDP2P->IDP2P_MotorGo(0, pResultPoint[nIdx].dPosX, pResultPoint[nIdx].dPosY);

		if (m_pDP2P->IDP2P_GetMotionEnd(0) == FALSE) continue;


		//2. AF Delay
		Sleep(nAFDelay);

		//3. Z축 값 얻어오기
		m_pDP2P->IDP2P_GetAFMZPosition(0, dZpos);
		
		// set result
		pResultPoint[nIdx].dPosZ = dZpos/1000.0;
		m_pDP2P->IDP2P_SetDlgFlatness(nIdx);
	}

	//AFM Tracking OFF
	m_pDP2P->IDP2P_SetAFMTracking(0, FALSE);

	// make 3d data file
	m_pManager->SaveDiagnosis3DImageFile_Flatness();

	// make result file
	m_pManager->SaveDiagnosisFile_Flatness(nFlatnessMode);

	m_pDP2P->IDP2P_UpdateDialog(2);

	return TRUE;
}

int CDiagnosisProcessor::ProcessFlatness_Manual()
{
	if (m_pDP2P == NULL) return 0;

	int nSelModuleIndex = m_pDP2P->IDP2P_GetSelectedModuleIndex();
	double dPosZ = 0.;

	// AF Home
	m_pDP2P->IDP2P_AFMHomePosition(nSelModuleIndex);
	Sleep(5000);

	// AF Tracking ON
	m_pDP2P->IDP2P_SetAFMTracking(nSelModuleIndex, TRUE);
	Sleep(500);

	// get Z Value
	m_pDP2P->IDP2P_GetAFMZPosition(nSelModuleIndex, dPosZ);

	//AFM Tracking OFF
	m_pDP2P->IDP2P_SetAFMTracking(nSelModuleIndex, FALSE);
	
	CString strPosZ;
	strPosZ.Format(_T("Position Z : %6lf"), dPosZ);
	AfxMessageBox(strPosZ);

	return TRUE;
}

int CDiagnosisProcessor::ProcessSimulation()
{

	if (m_pDP2P == NULL || m_pManager == NULL) return 0;

	CDiagnosisInfo * pSettingInfo = m_pManager->GetDiagnosisInfo();
	if (pSettingInfo == NULL) return 0;

	int nSelModuleIndex = m_pDP2P->IDP2P_GetSelectedModuleIndex();
	int nFlatnessMode = pSettingInfo->GetFlatnessMode();
	int nTotalCount = pSettingInfo->GetRangeCount_Flatness();

	CDiagnosisResult * pProcessResult = m_pManager->GetDiagnosisResult_Flatness();
	if (pProcessResult == NULL) return 0;

	pProcessResult->SetRangeCount_Flatness(nTotalCount);
	pProcessResult->SetFlatnessMode(nFlatnessMode);
	pProcessResult->SetPositionData_Flatness(nTotalCount);

	SPositionData * pResultPoint = pProcessResult->GetPositionData_Flatness(nSelModuleIndex);
	if (pResultPoint == NULL) return 0;

	int nGlassSizeX = pSettingInfo->GetGlassSizeX_Flatness();
	int nGlassSizeY = pSettingInfo->GetGlassSizeY_Flatness();

	int nAFDelay = pSettingInfo->GetAFDelay();

	pProcessResult->PathScheduling_Flatness(pResultPoint, nGlassSizeX, nGlassSizeY);

	double dTempPosZ = 0.;
	for (int nIdx = 0; nIdx < nTotalCount; nIdx++)
	{
		pResultPoint[nIdx].dPosZ = dTempPosZ++;
		Sleep(50);
		m_pDP2P->IDP2P_SetDlgFlatness(nIdx);

	}
	// make 3d data file
	m_pManager->SaveDiagnosis3DImageFile_Flatness();

	// make result file
	m_pManager->SaveDiagnosisFile_Flatness(nFlatnessMode);

	return TRUE;
}

int CDiagnosisProcessor::ProcessDiagnosisJudge(int nMode)
{
	for (int i = 0; i < 2; i++)
	{
		int nSelModuleIndex = i;

		CDiagnosisInfo* pSettingInfo = m_pManager->GetDiagnosisInfo();
		if (pSettingInfo == NULL) {
			m_pDP2P->IDP2P_UpdateDialog(4);
			return 0;
		}

		CDiagnosisResult* pProcessResult = m_pManager->GetDiagnosisResult_Squareness(nSelModuleIndex); // 0412 kyh 직각도 측정 모듈에 대한 결과정보
		if (pProcessResult == NULL) {
			m_pDP2P->IDP2P_UpdateDialog(4);
			return 0;
		}

		CDiagnosisResult* pProcessWSIResult = m_pManager->GetDiagnosisResult_Wsi(nSelModuleIndex); // 0412 kyh WSI 측정 모듈에 대한 결과 정보
		if (pProcessWSIResult == NULL) {
			m_pDP2P->IDP2P_UpdateDialog(6);
			return 0;
		}

		CString strMessage = _T("");
		if (nMode == DiagnosisMode_All || nMode == DiagnosisMode_Review || nMode == DiagnosisMode_Squareness)
		{
			double dDate = (90 - pProcessResult->GetGantryDegree());
			if (abs(dDate) >= abs(pSettingInfo->GetJudgeData_Degree())) // 0412 kyh 직각도에서 나온 Dgree 값이 설정한 Judge 값보다 크거나 같을경우
			{

				m_pDP2P->IDP2P_DiagnosisSendJudgeAlarm(); // 알람 발생
				strMessage.Format(_T("[Judge Data] [Gantry %d]Diagnosis Error ! GantryDegree[%lf] Judge[%lf]"), i, dDate, pSettingInfo->GetJudgeData_Degree());
				m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
			}
		}

		if (nMode == DiagnosisMode_All || nMode == DiagnosisMode_Wsi)
		{
			if (pProcessWSIResult->getWSI_RTB() >= pSettingInfo->GetJudgeData_3Sigma() || pProcessWSIResult->getWSI_RTB() <= 0) // 0412 kyh WSI 표준편차 비교
			{
				m_pDP2P->IDP2P_DiagnosisSendJudgeAlarm(); // 알람 발생
				strMessage.Format(_T("[Judge Data] [WSI %d]Diagnosis Error ! WSI RTB[%lf] Judge[%lf]"), i, pProcessWSIResult->getWSI_RTB(), pSettingInfo->GetJudgeData_3Sigma());
				m_pDP2P->IDP2P_DisplayMessage(0, strMessage);
			}
		}

	}
	//#3407 KYH 자가진단 Judge 판정 및 알람 발생 기능 ADD END

	//컴플릿트 신호 보내기
	m_pDP2P->IDP2P_DiagnosisSendCompleteSig();
	return 1;
}

BOOL CDiagnosisProcessor::CalculateSquareness(int nIndex)
{
	if (m_pDP2P == NULL || m_pManager == NULL) return 0;

	int nSelModuleIndex = nIndex;

	// setting info
	const CDiagnosisInfo* pSettingInfo = m_pManager->GetDiagnosisInfo();
	if (pSettingInfo == NULL) return 0;
	const CDiagnosisResult* pSettingResult = pSettingInfo->GetSettingResult_Squareness(nSelModuleIndex);
	if (pSettingResult == NULL) return 0;

	// find result
	CDiagnosisResult* pProcessResult = m_pManager->GetDiagnosisResult_Squareness(nSelModuleIndex);
	if (pProcessResult == NULL) return 0;

	int nPanelCount = pProcessResult->GetPanelCount_Squareness();
	double dFrameWidth = pSettingInfo->GetCameraFrameWidth();
	double dFrameHeight = pSettingInfo->GetCameraFrameHeight();
	double dResol = pSettingInfo->GetCameraResolution();

	// calc image direction
	//enum MotorOriginDirection		{ MotorOriginDir_LeftTop=0, MotorOriginDir_RightTop, MotorOriginDir_LeftBottom, MotorOriginDir_RightBottom, MotorOriginDir_Count };
	int nDirX[2] = { 0, }, nDirY[2] = { 0, };
	int nMotorDir = m_pDP2P->IDP2P_GetOrigionMotorDir() + nSelModuleIndex;
	switch (nMotorDir)
	{
	case MotorOriginDir_LeftTop:
		nDirX[nSelModuleIndex] = 1;
		nDirY[nSelModuleIndex] = 1;
		break;
	case MotorOriginDir_LeftBottom:
		nDirX[nSelModuleIndex] = 1;
		nDirY[nSelModuleIndex] = -1;
		break;
	case MotorOriginDir_RightTop:
		nDirX[nSelModuleIndex] = -1;
		nDirY[nSelModuleIndex] = 1;
		break;
	case MotorOriginDir_RightBottom:
		nDirX[nSelModuleIndex] = -1;
		nDirY[nSelModuleIndex] = -1;
		break;
	}

	switch (nPanelCount)
	{
	case 2:
	{
		double dMotorPosX[2] = { 0, };
		double dMotorPosY[2] = { 0, };
		double dPixelPosX[2] = { 0, };
		double dPixelPosY[2] = { 0, };

		for (int nIdx = 0; nIdx < nPanelCount; nIdx++)
		{
			const SPositionData* pSettingPos = pSettingResult->GetPositionData_Squareness(nIdx);
			const SPositionData* pDataPos = pProcessResult->GetPositionData_Squareness(nIdx);
			if (pSettingPos == NULL || pDataPos == NULL) continue;

			dMotorPosX[nIdx] = pSettingPos->dPosX;
			dMotorPosY[nIdx] = pSettingPos->dPosY;

			dPixelPosX[nIdx] = pDataPos->dPixelX;
			dPixelPosY[nIdx] = pDataPos->dPixelY;
		}

		// calc degree
		double dCenter2MarkX[2] = { 0, };
		double dCenter2MarkY[2] = { 0, };

		dCenter2MarkX[0] = (dPixelPosX[0] - dFrameWidth / 2) * dResol;
		dCenter2MarkX[1] = (dPixelPosX[1] - dFrameWidth / 2) * dResol;
		dCenter2MarkY[0] = (dPixelPosY[0] - dFrameHeight / 2) * dResol;
		dCenter2MarkY[1] = (dPixelPosY[1] - dFrameHeight / 2) * dResol;

		double dx = abs((dMotorPosX[0] + dCenter2MarkX[0] * nDirX[nSelModuleIndex]) - (dMotorPosX[1] + dCenter2MarkX[1] * nDirX[nSelModuleIndex]));
		double dy = abs((dMotorPosY[0] + dCenter2MarkY[0] * nDirY[nSelModuleIndex]) - (dMotorPosY[1] + dCenter2MarkY[1] * nDirY[nSelModuleIndex]));
		double dRadian = -1.0 * atan(dx / dy);
		double dDegree = ToDegree(dRadian);

		// trans degree
		dDegree = 90 - dDegree;

		pProcessResult->SetGantryDegree(dDegree);

		break;
	}

	case 3:
	{
		double dMotorPosX[3] = { 0, };
		double dMotorPosY[3] = { 0, };
		double dPixelPosX[3] = { 0, };
		double dPixelPosY[3] = { 0, };

		for (int nIdx = 0; nIdx < nPanelCount; nIdx++)
		{
			//LYW 210811
			const SPositionData* pSettingPos;
			const SPositionData* pDataPos;

			if (nSelModuleIndex == 1)
			{
				pSettingPos = pSettingResult->GetPositionData_Squareness(nIdx);
				pDataPos = pProcessResult->GetPositionData_Squareness(nIdx + 3);
			}
			else
			{
				pSettingPos = pSettingResult->GetPositionData_Squareness(nIdx);
				pDataPos = pProcessResult->GetPositionData_Squareness(nIdx);
			}
			//LYW 210811
			if (pSettingPos == NULL || pDataPos == NULL) continue;

			dMotorPosX[nIdx] = pSettingPos->dPosX;
			dMotorPosY[nIdx] = pSettingPos->dPosY;

			dPixelPosX[nIdx] = pDataPos->dPixelX;
			dPixelPosY[nIdx] = pDataPos->dPixelY;
		}

		// calc gantry degree
		double dCenter2MarkX[3] = { 0, };
		double dCenter2MarkY[3] = { 0, };

		dCenter2MarkX[0] = (dPixelPosX[0] - dFrameWidth / 2) * dResol;
		dCenter2MarkY[0] = (dPixelPosY[0] - dFrameHeight / 2) * dResol;
		dCenter2MarkX[1] = (dPixelPosX[1] - dFrameWidth / 2) * dResol;
		dCenter2MarkY[1] = (dPixelPosY[1] - dFrameHeight / 2) * dResol;

		double dx = abs((dMotorPosX[0] + dCenter2MarkX[0] * nDirX[nSelModuleIndex]) - (dMotorPosX[1] + dCenter2MarkX[1] * nDirX[nSelModuleIndex]));
		double dy = abs((dMotorPosY[0] + dCenter2MarkY[0] * nDirY[nSelModuleIndex]) - (dMotorPosY[1] + dCenter2MarkY[1] * nDirY[nSelModuleIndex]));
		double dRadian = -1.0 * atan(dx / dy);
		double dGantryDegree = ToDegree(dRadian);

		// calc x scale degree
		dCenter2MarkX[2] = (dPixelPosX[2] - dFrameWidth / 2) * dResol;
		dCenter2MarkY[2] = (dPixelPosY[2] - dFrameHeight / 2) * dResol;

		dx = abs((dMotorPosX[0] + dCenter2MarkX[0] * nDirX[nSelModuleIndex]) - (dMotorPosX[2] + dCenter2MarkX[2] * nDirX[nSelModuleIndex]));
		dy = abs((dMotorPosY[0] + dCenter2MarkY[0] * nDirY[nSelModuleIndex]) - (dMotorPosY[2] + dCenter2MarkY[2] * nDirY[nSelModuleIndex]));
		dRadian = -1.0 * atan(dy / dx);
		double dScaleDegree = ToDegree(dRadian);

		// trans degree - select
		//double dDegree = 90 - dGantryDegree;
		double dDegree = 90 - dGantryDegree - dScaleDegree;

		// calc virtual x panel position
		double dv = 0., dx2 = 0., dy2 = 0.;
		if (dy > dx)
		{
			dx2 = dy;
			dv = dx2 / cos(dRadian);
			dy2 = dx2 * tan(dRadian);

			SPositionData* dataCalc = pProcessResult->GetPositionData_CalcResult();
			if (dataCalc)
			{
				dataCalc->dPosAssemX = dMotorPosX[0] + dv;
				dataCalc->dPosAssemY = dMotorPosY[0] + dy2;
			}
		} //taek 210105

		pProcessResult->SetGantryDegree(dDegree);
		pProcessResult->SetXScaleDegree(dScaleDegree);

		break;
	}	

	default:
		break;
	}

	

	return TRUE;
}