|
|
#include "StdAfx.h"
|
|
|
#include "FrameIMP_Down.h"
|
|
|
|
|
|
CFrameIMPDown_::CFrameIMPDown_(void)
|
|
|
{
|
|
|
_tcscpy(Name, _T("IMP下行"));
|
|
|
FrameLength = 6;
|
|
|
HeadLength = 1;
|
|
|
Head[0] = 0x55;
|
|
|
memcpy(Addr(), Head, HeadLength);
|
|
|
CheckLength = 1;
|
|
|
CheckPos = FrameLength - 2;
|
|
|
|
|
|
memset(&Data,0,sizeof(DataIMPDown));
|
|
|
memset(recvDataValue, 0, 6);
|
|
|
}
|
|
|
|
|
|
|
|
|
CFrameIMPDown_::~CFrameIMPDown_(void)
|
|
|
{
|
|
|
}
|
|
|
|
|
|
BOOL CFrameIMPDown_::FullFrame()
|
|
|
{
|
|
|
int HeaderPos, HeaderPos2;
|
|
|
HeaderPos = FindHead(0, Length() - HeadLength); //找第一个帧头
|
|
|
if (0 == HeaderPos) {
|
|
|
//帧头在最前面
|
|
|
if (OnCheck()) //CRC校验
|
|
|
DoCheck();
|
|
|
else {
|
|
|
if (Length() < FrameLength) //数据长度不足，未通过CRC校验
|
|
|
{
|
|
|
if (Size() < FrameLength) //误码，未通过CRC校验
|
|
|
{
|
|
|
DoDropBYTE((UINT16)HeadLength); //丢弃帧头
|
|
|
}
|
|
|
return TRUE;
|
|
|
}
|
|
|
else //误码，未通过CRC校验
|
|
|
{
|
|
|
HeaderPos2 = FindHead(HeadLength, Length() - HeadLength);
|
|
|
if (HeaderPos2 >= 0)
|
|
|
{
|
|
|
Drop((UINT16) HeaderPos2);
|
|
|
return FALSE;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
DoDropBYTE((UINT16) (Length()-(HeadLength-1)));
|
|
|
return TRUE;
|
|
|
}
|
|
|
}
|
|
|
}
|
|
|
} else if (HeaderPos < 0) {
|
|
|
//没找到帧头
|
|
|
DoDropBYTE((UINT16) (Length()-(HeadLength-1)));
|
|
|
} else {
|
|
|
//丢弃帧头前的数据
|
|
|
DoDropBYTE((UINT16) HeaderPos);
|
|
|
}
|
|
|
return FALSE;
|
|
|
}
|
|
|
|
|
|
BOOL CFrameIMPDown_::OnCheck()
|
|
|
{
|
|
|
//数据帧校验
|
|
|
BYTE* p = Addr();
|
|
|
memcpy(recvDataValue, p, 5);
|
|
|
if (Length() < FrameLength)
|
|
|
{
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
struCHECK ck1=CheckCRC(p);
|
|
|
//if (p[CheckPos] == ck1.C0 && p[CheckPos + 1] == ck1.C1)//CRC校验
|
|
|
if (p[CheckPos] == ck1.C0 )//和校验
|
|
|
{
|
|
|
memcpy(recvDataValue, p, 5);
|
|
|
return true;
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
return false;
|
|
|
}
|
|
|
}
|
|
|
|
|
|
void CFrameIMPDown_::DoCheck()
|
|
|
{
|
|
|
CountFrameAll++;
|
|
|
CountFrameCheck++;
|
|
|
OnDataCheck();
|
|
|
Drop(FrameLength);
|
|
|
}
|
|
|
|
|
|
struCHECK CFrameIMPDown_::CheckCRC(BYTE* const p)
|
|
|
{
|
|
|
return MakeCheckSum(p+1, FrameLength - HeadLength - CheckLength - 1);//1为帧尾，IMP有一个字节的帧尾
|
|
|
}
|
|
|
|
|
|
void CFrameIMPDown_::Decode()
|
|
|
{
|
|
|
ProtocalIMPDown* pBuffIMP = (ProtocalIMPDown*)Addr();
|
|
|
Data.head = pBuffIMP->head;
|
|
|
Data.Bytes = pBuffIMP->Bytes;
|
|
|
Data.StatusWord = pBuffIMP->StatusWord;
|
|
|
Data.FaultWord = pBuffIMP->FaultWord;
|
|
|
Data.CHKSUM = pBuffIMP->CHKSUM;
|
|
|
Data.EndFlag = pBuffIMP->EndFlag;
|
|
|
} |