#include "stdafx.h"
#include "DoNothingDiosBoard.h"
#include <iostream>
#include <iomanip>

using namespace DIOS::Dev::Detail::MachineryECOM;

DoNothingDiosBoard::DoNothingDiosBoard()
{
}


DoNothingDiosBoard::~DoNothingDiosBoard()
{
}

bool DoNothingDiosBoard::Initialize(SCF* pSCF)
{
	return true;
}

bool DoNothingDiosBoard::SetPassiveDisconnectEventHandle(HANDLE handle)
{
	return true;
}

bool DoNothingDiosBoard::Connect(ResDataObject& Connection)
{
	return true;
}

bool DoNothingDiosBoard::Disonnect()
{
	return true;
}

DWORD DoNothingDiosBoard::Lock()
{
	return 0;
}

void  DoNothingDiosBoard::UnLock()
{
	
}

bool DoNothingDiosBoard::Send(SCFPacket *sendPacket, SCFPacket *recvPacket)
{
	//if(gcommLog) gcommLog->Info("[Send]->[%s]", FormatPacketString(sendPacket).c_str());
	{ if (gcommLog) { gcommLog->Info("[Send]->[{$}]", FormatPacketString(sendPacket).c_str()); } }

	auto len = sendPacket->GetPacketLen();

	std::cout << "send data len-> " << len << std::endl;
	char *packet = (char *)(*sendPacket);
	for (DWORD i = 0; i < len; ++i)
	{
		std::cout << setfill('0') << setw(2) << std::hex << (unsigned int)(unsigned char)packet[i] << " ";
	}

	std::cout << std::endl;

	return true;
}

bool DoNothingDiosBoard::ReceiveACK(SCFPacket* sendPacket, SCFPacket* recvPacket, char* pszContext, unsigned int& PacketLen)
{
	return true;
}

bool DoNothingDiosBoard::ReceiveFrame(SCFPacket* sendPacket, SCFPacket* recvPacket, FUNCTIONID Id, unsigned char FrameCmd, char* pszContext, unsigned int PacketLen, unsigned int& nDataLen)
{
	return true;
}

//bool DoNothingDiosBoard::ReceiveCANFrame(SCFPacket* sendPacket, SCFPacket* recvPacket, CAN_ID Id, unsigned short stdid, CAN_PARAM& params)
//{
//	return true;
//}

void DoNothingDiosBoard::QueNotifyPacket(SCFPacket *pPacket)
{
	
}


std::string DoNothingDiosBoard::FormatPacketString(SCFPacket *packet)
{
	std::string formated = "";

	if (!packet || packet->GetPacketLen() <= 0)
	{
		return formated;
	}

	auto packetLength = packet->GetPacketLen();
	char *chpacket = (char *)(*packet);
	char tmp[16] = { 0 };
	for (DWORD i = 0; i < packetLength; ++i)
	{
		if ((i >= 2 && i <= 6) || (i == packetLength - 3))
		{
			formated = formated + "#";
		}
		memset(tmp, 0, sizeof(tmp));
		sprintf_s(tmp, "%02X", (unsigned char)chpacket[i]);
		formated = formated + std::string(tmp);
	}

	return formated;
}