#include "StdAfx.h"
|
#include "TriggerControl_Mvsol.h"
|
|
CTriggerControl_Mvsol::CTriggerControl_Mvsol(void)
|
{
|
m_hTriggerControl = NULL;
|
}
|
|
CTriggerControl_Mvsol::~CTriggerControl_Mvsol(void)
|
{
|
DisConnect();
|
}
|
|
BOOL CTriggerControl_Mvsol::Connect(int nComPort)
|
{
|
if(IsConnect() == TRUE)
|
return TRUE;
|
|
DCB dcb;
|
|
CString strPort;
|
|
if(10 <= nComPort)
|
strPort.Format(_T("\\\\.\\COM%d"), nComPort);
|
else
|
strPort.Format(_T("COM%d"), nComPort);
|
|
m_hTriggerControl = CreateFile( strPort, GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL );
|
|
if (m_hTriggerControl == INVALID_HANDLE_VALUE)
|
{
|
CloseHandle(m_hTriggerControl);
|
m_hTriggerControl = NULL;
|
return FALSE;
|
}
|
|
dcb.DCBlength = sizeof(DCB);
|
if (GetCommState(m_hTriggerControl,(LPDCB) &dcb))
|
{
|
dcb.DCBlength = sizeof(DCB);
|
dcb.BaudRate = CBR_115200;
|
dcb.ByteSize = 8;
|
//dcb.fParity = FALSE;
|
dcb.Parity = NOPARITY;
|
//dcb.StopBits = 1;
|
//dcb.fOutxCtsFlow = 0;
|
//dcb.fOutxDsrFlow = 0;
|
//dcb.fOutX = 0;
|
//dcb.fInX = 0;
|
|
// Serial Buadrate : 115,200bps
|
// Databit : 8
|
// Parity : None
|
// Stop bit : 1
|
// Flow control : None
|
|
if (!SetCommState(m_hTriggerControl,(LPDCB) &dcb))
|
{
|
CloseHandle(m_hTriggerControl);
|
m_hTriggerControl = NULL;
|
return FALSE;
|
}
|
}
|
else
|
{
|
CloseHandle(m_hTriggerControl);
|
m_hTriggerControl = NULL;
|
return FALSE;
|
}
|
|
return TRUE;
|
}
|
|
BOOL CTriggerControl_Mvsol::DisConnect()
|
{
|
if(IsConnect() == FALSE)
|
return TRUE;
|
|
if (m_hTriggerControl)
|
CloseHandle(m_hTriggerControl);
|
m_hTriggerControl = NULL;
|
|
return TRUE;
|
}
|
|
|
|
BOOL CTriggerControl_Mvsol::IsConnect()
|
{
|
return (m_hTriggerControl == NULL) ? FALSE : TRUE;
|
}
|
|
// 飘府芭0锅 盲澄狼 浚内歹 涝仿阑 0锅栏肺 静扁
|
// SND : 02 57 00 00 00 74 00 80 00 4B 03
|
// ACK : 02 77 00 00 00 74 00 80 00 6B 03
|
// 飘府芭1锅 盲澄狼 浚内歹 涝仿阑 0锅栏肺 静扁
|
// SND : 02 57 00 01 00 74 00 80 00 4C 03
|
// ACK : 02 77 00 01 00 74 00 80 00 6C 03
|
// 飘府芭2锅 盲澄狼 浚内歹 涝仿阑 0锅栏肺 静扁
|
// SND : 02 57 00 7D 22 00 74 00 80 00 4D 03
|
// ACK : 02 77 00 7D 22 00 74 00 80 00 6D 03
|
// 飘府芭3锅 盲澄狼 浚内歹 涝仿阑 0锅栏肺 静扁
|
// SND : 02 57 00 7D 23 00 74 00 80 00 4E 03
|
// ACK : 02 77 00 7D 23 00 74 00 80 00 6E 03
|
|
// 飘府芭0锅 盲澄狼 浚内歹 涝仿阑 1锅栏肺 静扁
|
// SND : 02 57 00 00 10 74 00 80 00 5B 03
|
// ACK : 02 77 00 00 10 74 00 80 00 7B 03
|
// 飘府芭1锅 盲澄狼 浚内歹 涝仿阑 1锅栏肺 静扁
|
// SND : 02 57 00 01 10 74 00 80 00 5C 03
|
// ACK : 02 77 00 00 10 74 00 80 00 7B 03
|
// 飘府芭2锅 盲澄狼 浚内歹 涝仿阑 1锅栏肺 静扁
|
// SND : 02 57 00 7D 22 10 74 00 80 00 5D 03
|
// ACK : 02 77 00 7D 22 10 74 00 80 00 7D 5D 03
|
// 飘府芭3锅 盲澄狼 浚内歹 涝仿阑 1锅栏肺 静扁
|
// SND : 02 57 00 7D 23 10 74 00 80 00 5E 03
|
// ACK : 02 77 00 7D 23 10 74 00 80 00 7E 03
|
|
|
BOOL CTriggerControl_Mvsol::SetSelectEncoder(int nEncoderChanel)
|
{
|
if(IsConnect() == FALSE)
|
return FALSE;
|
|
SetSelectEncoder_Trigger_Out_0(nEncoderChanel);
|
SetSelectEncoder_Trigger_Out_1(nEncoderChanel);
|
SetSelectEncoder_Trigger_Out_2(nEncoderChanel);
|
SetSelectEncoder_Trigger_Out_3(nEncoderChanel);
|
|
return TRUE;
|
}
|
|
BOOL CTriggerControl_Mvsol::SetSelectEncoder_Trigger_Out_0(int nEncoderChanel)
|
{
|
BYTE Data[64];
|
memset(&Data[0],0x00,sizeof(Data));
|
|
DWORD dwIndex = 0;
|
|
switch(nEncoderChanel)
|
{
|
case 0:
|
// 02 57 00 00 00 74 00 80 00 4B 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x4B;
|
Data[dwIndex++] = 0x03;
|
break;
|
case 1:
|
// 02 57 00 00 10 74 00 80 00 5B 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x10;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x5B;
|
Data[dwIndex++] = 0x03;
|
break;
|
default:
|
return FALSE;
|
}
|
|
DWORD NumberOfBytesWritten;
|
|
BOOL bRet = WriteFile( m_hTriggerControl,(LPCVOID) Data, dwIndex,(LPDWORD) &NumberOfBytesWritten, NULL);
|
|
return bRet;
|
}
|
|
BOOL CTriggerControl_Mvsol::SetSelectEncoder_Trigger_Out_1(int nEncoderChanel)
|
{
|
BYTE Data[64];
|
memset(&Data[0],0x00,sizeof(Data));
|
|
DWORD dwIndex = 0;
|
|
switch(nEncoderChanel)
|
{
|
case 0:
|
// 02 57 00 01 00 74 00 80 00 4C 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x01;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x4C;
|
Data[dwIndex++] = 0x03;
|
break;
|
case 1:
|
// 02 57 00 01 10 74 00 80 00 5C 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x01;
|
Data[dwIndex++] = 0x10;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x5C;
|
Data[dwIndex++] = 0x03;
|
break;
|
default:
|
return FALSE;
|
}
|
|
DWORD NumberOfBytesWritten;
|
|
BOOL bRet = WriteFile( m_hTriggerControl,(LPCVOID) Data, dwIndex,(LPDWORD) &NumberOfBytesWritten, NULL);
|
|
return bRet;
|
}
|
|
BOOL CTriggerControl_Mvsol::SetSelectEncoder_Trigger_Out_2(int nEncoderChanel)
|
{
|
BYTE Data[64];
|
memset(&Data[0],0x00,sizeof(Data));
|
|
DWORD dwIndex = 0;
|
|
switch(nEncoderChanel)
|
{
|
case 0:
|
// 02 57 00 7D 22 00 74 00 80 00 4D 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x7D;
|
Data[dwIndex++] = 0x22;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x4D;
|
Data[dwIndex++] = 0x03;
|
break;
|
case 1:
|
// 02 57 00 7D 22 10 74 00 80 00 5D 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x7D;
|
Data[dwIndex++] = 0x22;
|
Data[dwIndex++] = 0x10;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x5D;
|
Data[dwIndex++] = 0x03;
|
break;
|
default:
|
return FALSE;
|
}
|
|
DWORD NumberOfBytesWritten;
|
|
BOOL bRet = WriteFile( m_hTriggerControl,(LPCVOID) Data, dwIndex,(LPDWORD) &NumberOfBytesWritten, NULL);
|
|
return bRet;
|
}
|
|
BOOL CTriggerControl_Mvsol::SetSelectEncoder_Trigger_Out_3(int nEncoderChanel)
|
{
|
BYTE Data[64];
|
memset(&Data[0],0x00,sizeof(Data));
|
|
DWORD dwIndex = 0;
|
|
switch(nEncoderChanel)
|
{
|
case 0:
|
// 02 57 00 7D 23 00 74 00 80 00 4E 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x7D;
|
Data[dwIndex++] = 0x23;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x4E;
|
Data[dwIndex++] = 0x03;
|
break;
|
case 1:
|
// 02 57 00 7D 23 10 74 00 80 00 5E 03
|
Data[dwIndex++] = 0x02;
|
Data[dwIndex++] = 0x57;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x7D;
|
Data[dwIndex++] = 0x23;
|
Data[dwIndex++] = 0x10;
|
Data[dwIndex++] = 0x74;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x80;
|
Data[dwIndex++] = 0x00;
|
Data[dwIndex++] = 0x5E;
|
Data[dwIndex++] = 0x03;
|
break;
|
default:
|
return FALSE;
|
}
|
|
DWORD NumberOfBytesWritten;
|
|
BOOL bRet = WriteFile( m_hTriggerControl,(LPCVOID) Data, dwIndex,(LPDWORD) &NumberOfBytesWritten, NULL);
|
|
return bRet;
|
}
|
