|
#include "stdafx.h"
|
#include "CHTotalPitchMeasure/TotalPitchMeasure.h"
|
//#include "TotalPitchMeasure.h"
|
|
CTotalPitchMeasure::CTotalPitchMeasure()
|
{
|
m_pTP2P = NULL;
|
Reset();
|
}
|
|
CTotalPitchMeasure::~CTotalPitchMeasure()
|
{
|
m_pTP2P = NULL;
|
Reset();
|
}
|
|
void CTotalPitchMeasure::Reset()
|
{
|
for(int nCnt=0; nCnt<4; nCnt++)
|
{
|
m_dAlignMarkPositionX[nCnt] = 0.0;
|
m_dAlignMarkPositionY[nCnt] = 0.0;
|
|
m_dAlignMarkCenterPosX[nCnt] = 0.0;
|
m_dAlignMarkCenterPosY[nCnt] = 0.0;
|
}
|
|
m_dGlassSizeWidth = 0.0;
|
m_dGlassSizeHeight = 0.0;
|
m_dStandardAlignMarkGlassPositionX = 0.0;
|
m_dStandardAlignMarkGlassPositionY = 0.0;
|
|
m_dAlignMarkCenterPositionX = 0.0;
|
m_dAlignMarkCenterPositionY = 0.0;
|
|
m_pAlignTempImage = NULL;
|
|
m_dTotlaPitchAB = 0.0;
|
m_dTotlaPitchCD = 0.0;
|
m_dTotlaPitchAC = 0.0;
|
m_dTotlaPitchBD = 0.0;
|
|
m_dAlignMarkShortDistance = 0.0;
|
m_dAlignMarkLongDistance = 0.0;
|
}
|
|
|
BOOL CTotalPitchMeasure::StartTotalPitchMeasure()
|
{
|
if(m_pTP2P == NULL) return NULL;
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Start Total Pitch Measure!!!"));
|
|
// 1. AlignMark CenterPosition Á¤º¸ ȹµæ
|
if(!GetAlignMarkCenterPosition()) return FALSE;
|
|
// 2. ³×±ºµ¥ÀÇ Align Mark PositionÀ» °è»êÇÑ´Ù
|
if(!CalculateAlignMarkPosition()) return FALSE;
|
|
// 3. ÃÖ¼Ò¹èÀ²·Î º¯°æ
|
if(!m_pTP2P->ITP2P_SetMinMagChange(0)) return FALSE;
|
|
// 4. À̵¿Çϸç Mark ¼öÁý ÁøÇà (Çϳª¶óµµ ½ÇÆÐÇÏ¸é ¹Ù·Î Fail ó¸®)
|
for(int nMarkIdx=0; nMarkIdx < 4; nMarkIdx++) // Mark 4°³ ÃøÁ¤
|
{
|
// 4-1. Motion À̵¿
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Start Move AlignMark : %d"), nMarkIdx);
|
if(!MoveAlignMarkPosition(nMarkIdx))
|
{
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Error Move AlignMark : %d"), nMarkIdx);
|
return FALSE;
|
}
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] End Move AlignMark : %d"), nMarkIdx);
|
|
Sleep(1000);
|
|
// 4-2. Current Review Image ȹµæ ¹× ¸ÅĪ
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Start Get AlignMark Image : %d"), nMarkIdx);
|
if(!GetAlignMarkImageMatching(nMarkIdx))
|
{
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Error Get AlignMark Image : %d"), nMarkIdx);
|
return FALSE;
|
}
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] End Get AlignMark Image : %d"), nMarkIdx);
|
}
|
|
// 5. TotalPitch ÃøÁ¤
|
if(!TotalPitchMeasure())
|
{
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] TotalPitch Measure Fail!!"));
|
return FALSE;
|
}
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] TotalPitch Measure Success!! AB : %.3lf, CD : %.3lf, AC : %.3lf, BD : %.3lf"), GetTotalPitchAB(), GetTotalPitchCD(), GetTotalPitchAC(), GetTotalPitchBD());
|
|
return TRUE;
|
}
|
|
BOOL CTotalPitchMeasure::CalculateAlignMarkPosition()
|
{
|
double dPositionX=0.0, dPositionY=0.0;
|
|
// Glass Size ȹµæ
|
if(!m_pTP2P->ITP2P_GetGlassSize(dPositionX, dPositionY)) return FALSE;
|
SetGlassSizeWidth(dPositionX);
|
SetGlassSizeHeight(dPositionY);
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] GlassSizeX : %.3lf, GlassSizeY : %.3lf!!"), dPositionX, dPositionY);
|
|
// ±âÁØ Align Mark Position ȹµæ
|
if(!m_pTP2P->ITP2P_GetAlignMarkPosition(dPositionX, dPositionY)) return FALSE;
|
SetStandardAlignPosX(dPositionX);
|
SetStandardAlignPosY(dPositionY);
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] MarkPositionX : %.3lf, MarkPositionY : %.3lf!!"), dPositionX, dPositionY);
|
|
// 4°³ÀÇ AlignMark Position °è»ê
|
|
// 300mm ¾ÈÂÊ¿¡¸¸ AlignMark°¡ ÀÖ´Ù°í Reference¸¦ ¼³Á¤ÇصдÙ.
|
int nReferenceSizeX = 300;
|
int nReferenceSizeY = 300;
|
|
//m_dAlignMarkPositionX[4] : ±âÁØÀÇ Mark°¡ 0, ±âÁØ MarkÀÇ Y¹Ý´ëÆíÀÌ 1, ±âÁØ MarkÀÇ X¹Ý´ëÆíÀÌ 2 ±âÁØÀº Ç×»ó ÀÛ¾÷ÀÚ±âÁØ ÁÂÇÏ
|
|
// X¼³°èÄ¡ °è»ê
|
if(GetStandardAlignPosX() > nReferenceSizeX)
|
{
|
m_dAlignMarkPositionX[0] = GetGlassSizeWidth() - GetStandardAlignPosX();
|
m_dAlignMarkPositionX[1] = GetGlassSizeWidth() - GetStandardAlignPosX();
|
m_dAlignMarkPositionX[2] = GetStandardAlignPosX();
|
m_dAlignMarkPositionX[3] = GetStandardAlignPosX();
|
}
|
else
|
{
|
m_dAlignMarkPositionX[0] = GetStandardAlignPosX();
|
m_dAlignMarkPositionX[1] = GetStandardAlignPosX();
|
m_dAlignMarkPositionX[2] = GetGlassSizeWidth() - GetStandardAlignPosX();
|
m_dAlignMarkPositionX[3] = GetGlassSizeWidth() - GetStandardAlignPosX();
|
}
|
|
// Y¼³°èÄ¡ °è»ê
|
if(GetStandardAlignPosY() > nReferenceSizeY)
|
{
|
m_dAlignMarkPositionY[0] = GetGlassSizeHeight() - GetStandardAlignPosY();
|
m_dAlignMarkPositionY[1] = GetStandardAlignPosY();
|
m_dAlignMarkPositionY[2] = GetGlassSizeHeight() - GetStandardAlignPosY();
|
m_dAlignMarkPositionY[3] = GetStandardAlignPosY();
|
}
|
else
|
{
|
m_dAlignMarkPositionY[0] = GetStandardAlignPosY();
|
m_dAlignMarkPositionY[1] = GetGlassSizeHeight() - GetStandardAlignPosY();
|
m_dAlignMarkPositionY[2] = GetStandardAlignPosY();
|
m_dAlignMarkPositionY[3] = GetGlassSizeHeight() - GetStandardAlignPosY();
|
}
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] 1 AlignMarkPosition : %.3lf, %.3lf"), m_dAlignMarkPositionX[0], m_dAlignMarkPositionY[0]);
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] 2 AlignMarkPosition : %.3lf, %.3lf"), m_dAlignMarkPositionX[1], m_dAlignMarkPositionY[1]);
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] 3 AlignMarkPosition : %.3lf, %.3lf"), m_dAlignMarkPositionX[2], m_dAlignMarkPositionY[2]);
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] 4 AlignMarkPosition : %.3lf, %.3lf"), m_dAlignMarkPositionX[3], m_dAlignMarkPositionY[3]);
|
|
SetAlignLongDistance(m_dAlignMarkPositionX[2] - m_dAlignMarkPositionX[0]);
|
SetAlignShortDistance(m_dAlignMarkPositionY[1] - m_dAlignMarkPositionY[0]);
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Align Mark Distance X : %.3lf, Y %.3lf"), GetAlignLongDistance(), GetAlignShortDistance());
|
|
|
return TRUE;
|
}
|
|
BOOL CTotalPitchMeasure::GetAlignMarkCenterPosition()
|
{
|
double dPositionX=0.0, dPositionY=0.0;
|
|
// Glass Size ȹµæ
|
if(!m_pTP2P->ITP2P_GetAlignMarkCenterPosition(dPositionX, dPositionY)) return FALSE;
|
SetAlignMarkCenterPosX(dPositionX);
|
SetAlignMarkCenterPosY(dPositionY);
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Align Mark Center Pos : %.3lf, %.3lf!"), dPositionX, dPositionY);
|
|
return TRUE;
|
}
|
|
BOOL CTotalPitchMeasure::MoveAlignMarkPosition(const int nMarkIndx)
|
{
|
// ¸ð¼Ç ¸í·ÉÀÌ °¡´É ÇÑ »óÅÂÀÎÁö È®ÀÎÇÑ´Ù (Motion End + Command OK)
|
if(m_pTP2P->ITP2P_GetMotionEnable()) // ³»ºÎ¿¡¼ ÃÖ´ë 5Ãʵ¿¾È Enable ½ÅÈ£ È®ÀÎÇÔ
|
{
|
if(!m_pTP2P->ITP2P_MoveMotorGlassPosition(0, GetAlignMarkPosX(nMarkIndx), GetAlignMarkPosY(nMarkIndx)))
|
{
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] %d Mark MovePos Fail!! : %.3lf, %.3lf!"), nMarkIndx, GetAlignMarkPosX(nMarkIndx), GetAlignMarkPosY(nMarkIndx));
|
return FALSE;
|
}
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] %d Mark MovePosCommand!! : %.3lf, %.3lf!"), nMarkIndx, GetAlignMarkPosX(nMarkIndx), GetAlignMarkPosY(nMarkIndx));
|
return TRUE;
|
}
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] MarkPosition MotionEnable Check Fail!!"), nMarkIndx);
|
|
return FALSE;;
|
}
|
|
BOOL CTotalPitchMeasure::GetAlignMarkImageMatching( const int nMarkIndx )
|
{
|
if(m_pTP2P->ITP2P_GetMotionEnable()) // ³»ºÎ¿¡¼ ÃÖ´ë 5Ãʵ¿¾È Enable ½ÅÈ£ È®ÀÎÇÔ
|
{
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Enabl Check Success %d"), nMarkIndx);
|
|
//sjb Test
|
//return TRUE;
|
// ReviewImage¿Í AlignTempleteImage¸¦ ¸ÅĪÇÑ´Ù.
|
double dResultCenterPosX = 0.0, dResultCenterPosY = 0.0;
|
if(!m_pTP2P->ITP2P_StartTemplateMatching(dResultCenterPosX, dResultCenterPosY)) return FALSE;
|
|
// ¸ÅĪ °á°ú¸¦ °á°ú Data¿¡ ä¿ö ³Ö´Â´Ù.
|
m_dAlignMarkCenterPosX[nMarkIndx] = dResultCenterPosX;
|
m_dAlignMarkCenterPosY[nMarkIndx] = dResultCenterPosY;
|
|
return TRUE;
|
}
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Matching MotionEnable Check Fail!!"), nMarkIndx);
|
|
return FALSE;
|
}
|
|
BOOL CTotalPitchMeasure::TotalPitchMeasure()
|
{
|
double dCameraResolution = 0.0;
|
dCameraResolution = m_pTP2P->ITP2P_GetCurrentResolution() / 1000.0; // ÇöÀç ¼³Á¤µÇ¾î ÀÖ´Â ReviewCameraÀÇ Çػ󵵸¦ °¡Á®¿È
|
if(dCameraResolution <= 0.0) return FALSE;
|
|
// Align Mark Center¿¡ ÀÖÀ»½Ã Çȼ¿ Position
|
double dAlignCenterPositionX = GetAlignMarkCenterPosX();
|
double dAlignCenterPositionY = GetAlignMarkCenterPosY();
|
|
// Align MarkÀÇ Àå,´Üº¯ ¼³°èÄ¡ ±æÀÌ
|
double dAlignMarkLongDistance = GetAlignLongDistance();
|
double dAlignMarkShortDistance = GetAlignShortDistance();
|
|
if(dAlignCenterPositionX <= 0.0 || dAlignCenterPositionY <= 0.0 || dAlignMarkLongDistance <= 0.0 || dAlignMarkShortDistance <= 0.0) return FALSE;
|
|
SetTotalPitchAB(dAlignMarkShortDistance + ((m_dAlignMarkCenterPosY[0] - m_dAlignMarkCenterPosY[1]) * dCameraResolution)); // ÁÂÇÏ -> Á»ó
|
SetTotalPitchCD(dAlignMarkShortDistance + ((m_dAlignMarkCenterPosY[2] - m_dAlignMarkCenterPosY[3]) * dCameraResolution)); // ¿ìÇÏ -> ¿ì»ó
|
SetTotalPitchAC(dAlignMarkLongDistance - ((m_dAlignMarkCenterPosX[0] - m_dAlignMarkCenterPosX[2]) * dCameraResolution)); // ÁÂÇÏ -> ¿ìÇÏ
|
SetTotalPitchBD(dAlignMarkLongDistance - ((m_dAlignMarkCenterPosX[1] - m_dAlignMarkCenterPosX[3]) * dCameraResolution)); // Á»ó -> ¿ì»ó
|
|
m_pTP2P->ITP2P_DisplayMessage(0, _T("[TotalPitchMeasre] Result Data, AB : %.3lf, CD : %.3lf, AC : %.3lf, BD : %.3lf"), GetTotalPitchAB(), GetTotalPitchCD(), GetTotalPitchAC(), GetTotalPitchBD());
|
|
return TRUE;
|
}
|
|
BOOL CTotalPitchMeasure::GetMotorEnable()
|
{
|
if(m_pTP2P == NULL) return NULL;
|
|
return m_pTP2P->ITP2P_GetMotionEnable();
|
}
|
