cdtframe.cpp

一个通讯管理机的源代码。比较好用。推荐

#include "cdtframe.h"

const BYTE CCDTFrame::m_abyCDTHEAD[6] = {0xeb,0x90,0xeb,0x90,0xeb,0x90}; 
 
BYTE g_check[256]= 
{ 
	0x0,0x7,0xE,0x9,0x1C,0x1B,0x12,0x15,0x38,0x3F,0x36,0x31,0x24,
	0x23,0x2A,0x2D,0x70,0x77,0x7E,0x79,0x6C,0x6B,0x62,0x65,0x48, 
	0x4F,0x46,0x41,0x54,0x53,0x5A,0x5D,0xE0,0xE7,0xEE,0xE9,0xFC, 
	0xFB,0xF2,0xF5,0xD8,0xDF,0xD6,0xD1,0xC4,0xC3,0xCA,0xCD,0x90, 
	0x97,0x9E,0x99,0x8C,0x8B,0x82,0x85,0xA8,0xAF,0xA6,0xA1,0xB4, 
	0xB3,0xBA,0xBD,0xC7,0xC0,0xC9,0xCE,0xDB,0xDC,0xD5,0xD2,0xFF, 
	0xF8,0xF1,0xF6,0xE3,0xE4,0xED,0xEA,0xB7,0xB0,0xB9,0xBE,0xAB, 
	0xAC,0xA5,0xA2,0x8F,0x88,0x81,0x86,0x93,0x94,0x9D,0x9A,0x27, 
	0x20,0x29,0x2E,0x3B,0x3C,0x35,0x32,0x1F,0x18,0x11,0x16,0x3, 
	0x4,0xD,0xA,0x57,0x50,0x59,0x5E,0x4B,0x4C,0x45,0x42,0x6F,0x68, 
	0x61,0x66,0x73,0x74,0x7D,0x7A,0x89,0x8E,0x87,0x80,0x95,0x92, 
	0x9B,0x9C,0xB1,0xB6,0xBF,0xB8,0xAD,0xAA,0xA3,0xA4,0xF9,0xFE, 
	0xF7,0xF0,0xE5,0xE2,0xEB,0xEC,0xC1,0xC6,0xCF,0xC8,0xDD,0xDA, 
	0xD3,0xD4,0x69,0x6E,0x67,0x60,0x75,0x72,0x7B,0x7C,0x51,0x56, 
	0x5F,0x58,0x4D,0x4A,0x43,0x44,0x19,0x1E,0x17,0x10,0x5,0x2, 
	0xB,0xC,0x21,0x26,0x2F,0x28,0x3D,0x3A,0x33,0x34,0x4E,0x49, 
	0x40,0x47,0x52,0x55,0x5C,0x5B,0x76,0x71,0x78,0x7F,0x6A,0x6D, 
	0x64,0x63,0x3E,0x39,0x30,0x37,0x22,0x25,0x2C,0x2B,0x6,0x1, 
	0x8,0xF,0x1A,0x1D,0x14,0x13,0xAE,0xA9,0xA0,0xA7,0xB2,0xB5, 
	0xBC,0xBB,0x96,0x91,0x98,0x9F,0x8A,0x8D,0x84,0x83,0xDE,0xD9, 
	0xD0,0xD7,0xC2,0xC5,0xCC,0xCB,0xE6,0xE1,0xE8,0xEF,0xFA,0xFD, 
	0xF4,0xF3 
}; 
 
void CCDTFrame::SetupFrame(CFrameNode *pFNSend)
{
	m_byAddr = pFNSend->m_byDesAddr;
	if (pFNSend->m_pbyData && pFNSend->m_wSize)
	{
		m_wLength = pFNSend->m_wSize;
		memcpy(m_pData,pFNSend->m_pbyData,pFNSend->m_wSize);
	}
	else m_wLength = 0;
	m_byCID = pFNSend->m_byCID;
	m_bIsSetup = true;
}
	
bool CCDTFrame::FrameToBuffer(CDataNode &dn)
{
	bool bRet = false;
	if(m_bIsSetup) 
	{ 
		dn.SetSize(m_wLength+12);
		//dn.m_wSize = m_wLength+12;
		for(int j=0;j<6;j++) 
			dn.m_pbyData[j] = m_abyCDTHEAD[j]; 
		dn.m_pbyData[6]=0x71;
		dn.m_pbyData[7]=m_byCID; 
		dn.m_pbyData[8]=(BYTE)(m_wLength/6); 
		dn.m_pbyData[9]=m_byAddr;//source 
		dn.m_pbyData[10]=0;//1;//destination 
		memcpy(dn.m_pbyData+12,m_pData,m_wLength); 
		BYTE cha,chb; 
		BYTE* pbyTemp=dn.m_pbyData + 6; 
		for(int ii=0;ii<m_wLength/6+1;ii++) 
		{ 
			cha=0; 
			for(int i=0;i<5;i++) 
			{ 
				chb=cha^*pbyTemp++; 
				cha=g_check[chb]; 
			} 
			cha^=0xff; 
			*pbyTemp++=cha; 
		}
		bRet = true;
	} 
	return bRet;
}

void CCDTFrame::FrameToBuf(CFrameNode& fn)
{
	fn.m_byCID = m_byCID;
	fn.m_bySrcAddr = m_byAddr;
	if (m_wLength > 0)
	{
		fn.SetSize(m_wLength);
		memcpy(fn.m_pbyData,m_pData,m_wLength);
	}
}

BOOL CCDTFrame::VerifyCRC(BYTE *p) 
{ 
	BYTE cha,chb; 
	cha=0; 
	for(int i=0;i<5;i++) 
	{ 
		chb=cha^*p++; 
		cha=g_check[chb]; 
	} 
	cha^=0xff; 
	return (*p++==cha); 
} 
 
BOOL CCDTFrame::ByteIn(BYTE b) 
{ 
	BOOL bRet = FALSE; 
	if (!m_bStart) 
	{ 
		if (m_abyCDTHEAD[m_wInLength] == b) 
		{ 
			m_pbyInBuf[m_wInLength++] = b; 
			if (m_wInLength == 6)	m_bStart = TRUE; 
		} 
		else m_wInLength = 0; 
	}
	else if ((m_wInLength == 6) && (b == 0xeb))
		 m_wInLength -= 4;
	else if (m_wInLength == 8) 
	{ 
		m_byMsgWordSum=m_pbyInBuf[m_wInLength++] = b; 
	} 
	else if (m_wInLength == (m_byMsgWordSum*6+12-1)) 
	{ 
		m_pbyInBuf[m_wInLength++] = b;//++ 
		m_byMsgWordSum = 0; 
		bRet = true; 
	} 
	else  m_pbyInBuf[m_wInLength++] = b; 
	return bRet; 
}

bool CCDTFrame::BufferToFrame(CDQue* pPhyDQ)
{
	Reset();
	CDataNode *pDN;
	bool bIsComplete;
	m_wInLength = 0;
	while (bIsComplete = pPhyDQ->Get(pDN,50))
	{
		WORD wSize = 0;
		while ((wSize<pDN->m_wSize) && (pDN->m_wSize < 256*6))
		{
			if (ByteIn(pDN->m_pbyData[wSize++]))
			{
				delete pDN;
				goto check;
			}
		}
		delete pDN;
	}
check:
	if (bIsComplete)
	{
		WORD wSize = 0;
		for (WORD w=0; w<m_wInLength; w++) 
		{ 
			if (w < 6)
			{ 
				if (m_abyCDTHEAD[w] != m_pbyInBuf[w]) 
					return false; 
			} 
			else if (w == 6) 
			{ 
				if(!VerifyCRC(&m_pbyInBuf[6]))  
					return false; 
			} 
			else if (w == 7)	m_byCID = m_pbyInBuf[7]; 
			else if (w == 8)	m_wLength = 6 * m_pbyInBuf[8]; 
			else if ((w-12)%6 == 0) 
			{ 
				if(!VerifyCRC(&m_pbyInBuf[w])) 
				{
					m_wLength -= 6;
					wSize += 6;
				}
				else memcpy(m_pData + w-12-wSize, &m_pbyInBuf[w],6); 
			} 
		} 
	}
	return bIsComplete;
}