#include "StdAfx.h"
#include "LensChangeControl_Nikon.h"

CLensChangeControl_Nikon::CLensChangeControl_Nikon(int nIndex) : CLensChangeControl(nIndex)
{
}

CLensChangeControl_Nikon::~CLensChangeControl_Nikon(void)
{
}

BOOL CLensChangeControl_Nikon::Connect(const CLensChangeControlInfo& controlInfo)			
{ 
	m_ControlInfo = controlInfo;

	int nPort = _ttoi(controlInfo.GetConnectionPort());
	if (nPort<0) return FALSE;


	CString strProt;
	strProt.Format(_T("COM%d"), nPort);

	if(Open(strProt, controlInfo.GetBaudRate()) != ERROR_SUCCESS)
	{
		m_bConnected = FALSE;
		return FALSE;
	}

	m_bConnected = TRUE;
	
	return m_bConnected;
}

void CLensChangeControl_Nikon::Disconnect()				
{ 
	Close(); 
}

BOOL CLensChangeControl_Nikon::Backward()
{ 
	if (!m_bConnected) return FALSE;

	char strData[10];
	sprintf_s(strData, "cRCC%c", ASCII_CR);

	Write(strData, strlen(strData));
	//return SendData(strData, 5); 
	if(Write(strData, strlen(strData)) != ERROR_SUCCESS) return FALSE;

	return TRUE;
}

BOOL CLensChangeControl_Nikon::Forward()
{ 
	if (!m_bConnected) return FALSE;

	char strData[10];
	sprintf_s(strData, "cRCW%c", ASCII_CR);

	//return SendData(strData, 5);

	if(Write(strData, strlen(strData)) != ERROR_SUCCESS) return FALSE;

	return TRUE;
}

BOOL CLensChangeControl_Nikon::SetPosition(int nPos)
{
	if (!m_bConnected) return FALSE;

	char strData[10];
	sprintf_s(strData, "cRDC%d%c", nPos+1, ASCII_CR);

	//return SendData(strData, 6); 

	if(Write(strData, strlen(strData)) != ERROR_SUCCESS) return FALSE;

	m_nCurrentValue = nPos;

	return TRUE;
}

BOOL CLensChangeControl_Nikon::GetPosition(int& nPos)				
{ 
	if (!m_bConnected) return FALSE;

	char strData[10], strRecevie[10];
	sprintf_s(strData, "rRAR%c", ASCII_CR);

	//if (!SendData(strData, 5)) return FALSE;
	if(Write(strData, strlen(strData)) != ERROR_SUCCESS) return FALSE;

	::Sleep(50);

	//ReadDataWaiting();

// 	int nValue = ReadData(strData, 5 );
// 
// 	if (nValue<5) 
// 	{
// 		return FALSE;
// 	}

	if(Read(strData, strlen(strData)) != ERROR_SUCCESS)  return FALSE;

	sprintf_s(strRecevie, "%c", strData[4]);

	nPos = atoi(strRecevie);

	return TRUE;
}


BOOL CLensChangeControl_Nikon::GoHoming()
{

	return TRUE;
}