?? fifo.cpp
字號:
#include "StdAfx.h"
#include "Fifo.h"
/***********************************************************************************************/
/* CRC-8, poly = x^8 + x^2 + x^1 + x^0, init = 0 */
const char CRC_8_table[256] = {
0x00, 0x07, 0x0E, 0x09, 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,
(char)0xE0, (char)0xE7, (char)0xEE, (char)0xE9, (char)0xFC, (char)0xFB, (char)0xF2, (char)0xF5,
(char)0xD8, (char)0xDF, (char)0xD6, (char)0xD1, (char)0xC4, (char)0xC3, (char)0xCA, (char)0xCD,
(char)0x90, (char)0x97, (char)0x9E, (char)0x99, (char)0x8C, (char)0x8B, (char)0x82, (char)0x85,
(char)0xA8, (char)0xAF, (char)0xA6, (char)0xA1, (char)0xB4, (char)0xB3, (char)0xBA, (char)0xBD,
(char)0xC7, (char)0xC0, (char)0xC9, (char)0xCE, (char)0xDB, (char)0xDC, (char)0xD5, (char)0xD2,
(char)0xFF, (char)0xF8, (char)0xF1, (char)0xF6, (char)0xE3, (char)0xE4, (char)0xED, (char)0xEA,
(char)0xB7, (char)0xB0, (char)0xB9, (char)0xBE, (char)0xAB, (char)0xAC, (char)0xA5, (char)0xA2,
(char)0x8F, (char)0x88, (char)0x81, (char)0x86, (char)0x93, (char)0x94, (char)0x9D, (char)0x9A,
0x27, 0x20, 0x29, 0x2E, 0x3B, 0x3C, 0x35, 0x32,
0x1F, 0x18, 0x11, 0x16, 0x03, 0x04, 0x0D, 0x0A,
0x57, 0x50, 0x59, 0x5E, 0x4B, 0x4C, 0x45, 0x42,
0x6F, 0x68, 0x61, 0x66, 0x73, 0x74, 0x7D, 0x7A,
(char)0x89, (char)0x8E, (char)0x87, (char)0x80, (char)0x95, (char)0x92, (char)0x9B, (char)0x9C,
(char)0xB1, (char)0xB6, (char)0xBF, (char)0xB8, (char)0xAD, (char)0xAA, (char)0xA3, (char)0xA4,
(char)0xF9, (char)0xFE, (char)0xF7, (char)0xF0, (char)0xE5, (char)0xE2, (char)0xEB, (char)0xEC,
(char)0xC1, (char)0xC6, (char)0xCF, (char)0xC8, (char)0xDD, (char)0xDA, (char)0xD3, (char)0xD4,
0x69, 0x6E, 0x67, 0x60, 0x75, 0x72, 0x7B, 0x7C,
0x51, 0x56, 0x5F, 0x58, 0x4D, 0x4A, 0x43, 0x44,
0x19, 0x1E, 0x17, 0x10, 0x05, 0x02, 0x0B, 0x0C,
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,
0x06, 0x01, 0x08, 0x0F, 0x1A, 0x1D, 0x14, 0x13,
(char)0xAE, (char)0xA9, (char)0xA0, (char)0xA7, (char)0xB2, (char)0xB5, (char)0xBC, (char)0xBB,
(char)0x96, (char)0x91, (char)0x98, (char)0x9F, (char)0x8A, (char)0x8D, (char)0x84, (char)0x83,
(char)0xDE, (char)0xD9, (char)0xD0, (char)0xD7, (char)0xC2, (char)0xC5, (char)0xCC, (char)0xCB,
(char)0xE6, (char)0xE1, (char)0xE8, (char)0xEF, (char)0xFA, (char)0xFD, (char)0xF4, (char)0xF3
};
/* CRC-16, poly = x^16 + x^15 + x^2 + x^0, init = 0 */
const WORD CRC_16_table[256] = {
0x0000, 0x8005, 0x800f, 0x000a, 0x801b, 0x001e, 0x0014, 0x8011,
0x8033, 0x0036, 0x003c, 0x8039, 0x0028, 0x802d, 0x8027, 0x0022,
0x8063, 0x0066, 0x006c, 0x8069, 0x0078, 0x807d, 0x8077, 0x0072,
0x0050, 0x8055, 0x805f, 0x005a, 0x804b, 0x004e, 0x0044, 0x8041,
0x80c3, 0x00c6, 0x00cc, 0x80c9, 0x00d8, 0x80dd, 0x80d7, 0x00d2,
0x00f0, 0x80f5, 0x80ff, 0x00fa, 0x80eb, 0x00ee, 0x00e4, 0x80e1,
0x00a0, 0x80a5, 0x80af, 0x00aa, 0x80bb, 0x00be, 0x00b4, 0x80b1,
0x8093, 0x0096, 0x009c, 0x8099, 0x0088, 0x808d, 0x8087, 0x0082,
0x8183, 0x0186, 0x018c, 0x8189, 0x0198, 0x819d, 0x8197, 0x0192,
0x01b0, 0x81b5, 0x81bf, 0x01ba, 0x81ab, 0x01ae, 0x01a4, 0x81a1,
0x01e0, 0x81e5, 0x81ef, 0x01ea, 0x81fb, 0x01fe, 0x01f4, 0x81f1,
0x81d3, 0x01d6, 0x01dc, 0x81d9, 0x01c8, 0x81cd, 0x81c7, 0x01c2,
0x0140, 0x8145, 0x814f, 0x014a, 0x815b, 0x015e, 0x0154, 0x8151,
0x8173, 0x0176, 0x017c, 0x8179, 0x0168, 0x816d, 0x8167, 0x0162,
0x8123, 0x0126, 0x012c, 0x8129, 0x0138, 0x813d, 0x8137, 0x0132,
0x0110, 0x8115, 0x811f, 0x011a, 0x810b, 0x010e, 0x0104, 0x8101,
0x8303, 0x0306, 0x030c, 0x8309, 0x0318, 0x831d, 0x8317, 0x0312,
0x0330, 0x8335, 0x833f, 0x033a, 0x832b, 0x032e, 0x0324, 0x8321,
0x0360, 0x8365, 0x836f, 0x036a, 0x837b, 0x037e, 0x0374, 0x8371,
0x8353, 0x0356, 0x035c, 0x8359, 0x0348, 0x834d, 0x8347, 0x0342,
0x03c0, 0x83c5, 0x83cf, 0x03ca, 0x83db, 0x03de, 0x03d4, 0x83d1,
0x83f3, 0x03f6, 0x03fc, 0x83f9, 0x03e8, 0x83ed, 0x83e7, 0x03e2,
0x83a3, 0x03a6, 0x03ac, 0x83a9, 0x03b8, 0x83bd, 0x83b7, 0x03b2,
0x0390, 0x8395, 0x839f, 0x039a, 0x838b, 0x038e, 0x0384, 0x8381,
0x0280, 0x8285, 0x828f, 0x028a, 0x829b, 0x029e, 0x0294, 0x8291,
0x82b3, 0x02b6, 0x02bc, 0x82b9, 0x02a8, 0x82ad, 0x82a7, 0x02a2,
0x82e3, 0x02e6, 0x02ec, 0x82e9, 0x02f8, 0x82fd, 0x82f7, 0x02f2,
0x02d0, 0x82d5, 0x82df, 0x02da, 0x82cb, 0x02ce, 0x02c4, 0x82c1,
0x8243, 0x0246, 0x024c, 0x8249, 0x0258, 0x825d, 0x8257, 0x0252,
0x0270, 0x8275, 0x827f, 0x027a, 0x826b, 0x026e, 0x0264, 0x8261,
0x0220, 0x8225, 0x822f, 0x022a, 0x823b, 0x023e, 0x0234, 0x8231,
0x8213, 0x0216, 0x021c, 0x8219, 0x0208, 0x820d, 0x8207, 0x0202
};
/* CRC-CCITT, poly = x^16 + x^12 + x^5 + x^0, init = 0 */
const WORD CRC_CCITT_table[256]={
0x0000, 0x1021, 0x2042, 0x3063, 0x4084, 0x50a5, 0x60c6, 0x70e7,
0x8108, 0x9129, 0xa14a, 0xb16b, 0xc18c, 0xd1ad, 0xe1ce, 0xf1ef,
0x1231, 0x0210, 0x3273, 0x2252, 0x52b5, 0x4294, 0x72f7, 0x62d6,
0x9339, 0x8318, 0xb37b, 0xa35a, 0xd3bd, 0xc39c, 0xf3ff, 0xe3de,
0x2462, 0x3443, 0x0420, 0x1401, 0x64e6, 0x74c7, 0x44a4, 0x5485,
0xa56a, 0xb54b, 0x8528, 0x9509, 0xe5ee, 0xf5cf, 0xc5ac, 0xd58d,
0x3653, 0x2672, 0x1611, 0x0630, 0x76d7, 0x66f6, 0x5695, 0x46b4,
0xb75b, 0xa77a, 0x9719, 0x8738, 0xf7df, 0xe7fe, 0xd79d, 0xc7bc,
0x48c4, 0x58e5, 0x6886, 0x78a7, 0x0840, 0x1861, 0x2802, 0x3823,
0xc9cc, 0xd9ed, 0xe98e, 0xf9af, 0x8948, 0x9969, 0xa90a, 0xb92b,
0x5af5, 0x4ad4, 0x7ab7, 0x6a96, 0x1a71, 0x0a50, 0x3a33, 0x2a12,
0xdbfd, 0xcbdc, 0xfbbf, 0xeb9e, 0x9b79, 0x8b58, 0xbb3b, 0xab1a,
0x6ca6, 0x7c87, 0x4ce4, 0x5cc5, 0x2c22, 0x3c03, 0x0c60, 0x1c41,
0xedae, 0xfd8f, 0xcdec, 0xddcd, 0xad2a, 0xbd0b, 0x8d68, 0x9d49,
0x7e97, 0x6eb6, 0x5ed5, 0x4ef4, 0x3e13, 0x2e32, 0x1e51, 0x0e70,
0xff9f, 0xefbe, 0xdfdd, 0xcffc, 0xbf1b, 0xaf3a, 0x9f59, 0x8f78,
0x9188, 0x81a9, 0xb1ca, 0xa1eb, 0xd10c, 0xc12d, 0xf14e, 0xe16f,
0x1080, 0x00a1, 0x30c2, 0x20e3, 0x5004, 0x4025, 0x7046, 0x6067,
0x83b9, 0x9398, 0xa3fb, 0xb3da, 0xc33d, 0xd31c, 0xe37f, 0xf35e,
0x02b1, 0x1290, 0x22f3, 0x32d2, 0x4235, 0x5214, 0x6277, 0x7256,
0xb5ea, 0xa5cb, 0x95a8, 0x8589, 0xf56e, 0xe54f, 0xd52c, 0xc50d,
0x34e2, 0x24c3, 0x14a0, 0x0481, 0x7466, 0x6447, 0x5424, 0x4405,
0xa7db, 0xb7fa, 0x8799, 0x97b8, 0xe75f, 0xf77e, 0xc71d, 0xd73c,
0x26d3, 0x36f2, 0x0691, 0x16b0, 0x6657, 0x7676, 0x4615, 0x5634,
0xd94c, 0xc96d, 0xf90e, 0xe92f, 0x99c8, 0x89e9, 0xb98a, 0xa9ab,
0x5844, 0x4865, 0x7806, 0x6827, 0x18c0, 0x08e1, 0x3882, 0x28a3,
0xcb7d, 0xdb5c, 0xeb3f, 0xfb1e, 0x8bf9, 0x9bd8, 0xabbb, 0xbb9a,
0x4a75, 0x5a54, 0x6a37, 0x7a16, 0x0af1, 0x1ad0, 0x2ab3, 0x3a92,
0xfd2e, 0xed0f, 0xdd6c, 0xcd4d, 0xbdaa, 0xad8b, 0x9de8, 0x8dc9,
0x7c26, 0x6c07, 0x5c64, 0x4c45, 0x3ca2, 0x2c83, 0x1ce0, 0x0cc1,
0xef1f, 0xff3e, 0xcf5d, 0xdf7c, 0xaf9b, 0xbfba, 0x8fd9, 0x9ff8,
0x6e17, 0x7e36, 0x4e55, 0x5e74, 0x2e93, 0x3eb2, 0x0ed1, 0x1ef0
};
/***********************************************************************************************/
CFifo::CFifo(void)
{
InitializeCriticalSection(&FIFO_operation);
hEventRead = NULL;
hEventRead = CreateEvent(NULL, TRUE, FALSE, NULL);
hEventWrite = NULL;
hEventWrite = CreateEvent(NULL, TRUE, TRUE, NULL);
}
CFifo::~CFifo(void)
{
if(hEventRead)
{
CloseHandle(hEventRead);
hEventRead = NULL;
}
if(hEventWrite)
{
CloseHandle(hEventWrite);
hEventWrite = NULL;
}
DeleteCriticalSection(&FIFO_operation);
}
BOOL CFifo::ResetFIFO( char *BaseFIFO,
DWORD LenFIFO,
char EndFlag,
char TypeCRC,
DWORD ReadFlag,
DWORD WriteFlag,
BYTE ReadModeFIFO,
BYTE WriteModeFIFO
)
{
if (!hEventRead)
return FALSE;
if (!hEventWrite)
return FALSE;
EnterCriticalSection(&FIFO_operation);
FIFO_Base = BaseFIFO;
FIFO_Len = LenFIFO - 1;
cEndFlag = EndFlag;
nPtr_W = 0;
nPtr_W_inFrame = 0;
nPtr_R = 0;
CRC_Type = TypeCRC;
if(!(CRC_Type >= CRC_TYPE_8_BIT && CRC_Type <= CRC_TYPE_CCITT))
return FALSE;
wFrmNumToRead = ReadFlag;
wFrmNumToWrite = WriteFlag;
ReadFlagEnable = TRUE;
WriteFlagEnable = FALSE;
FIFO_ReadMode = ReadModeFIFO;
if(!(FIFO_ReadMode >= READ_BY_LENGTH && FIFO_ReadMode <= READ_ENDFLAG_WITH_CRC))
return FALSE;
FIFO_WriteMode = WriteModeFIFO;
if(!(FIFO_WriteMode >= WRITE_BY_LENGTH && FIFO_WriteMode <= WRITE_ENDFLAG_WITH_CRC))
return FALSE;
if(FIFO_ReadMode == READ_ENDFLAG_WITH_CRC || FIFO_WriteMode == WRITE_ENDFLAG_WITH_CRC)
{
if(cEndFlag != 0x7E)
return FALSE;
}
wFrameNum = 0;
ResetEvent(hEventRead);
SetEvent(hEventWrite);
LeaveCriticalSection(&FIFO_operation);
return TRUE;
}
void CFifo::EmptyFIFO()
{
EnterCriticalSection(&FIFO_operation);
nPtr_W = 0;
nPtr_W_inFrame = 0;
nPtr_R = 0;
// ReadFlagEnable = TRUE;
// WriteFlagEnable = FALSE;
wFrameNum = 0;
ResetEvent(hEventRead);
SetEvent(hEventWrite);
LeaveCriticalSection(&FIFO_operation);
}
DWORD CFifo::GetRoomLeft()
{
if(nPtr_W >= nPtr_R)
return FIFO_Len - (nPtr_W - nPtr_R);
else
return (nPtr_R - nPtr_W) - 1;
}
DWORD CFifo::WriteFIFO(char *BufIn, DWORD Len)
{
DWORD len_new, len_frm;
DWORD new_frame_num = 0;
EnterCriticalSection(&FIFO_operation);
if(FIFO_WriteMode == WRITE_ENDFLAG_WITH_CRC)
{
len_frm = FrameConstructor(BufIn, Len);
len_new = PutDataIntoFIFO(BufTempIn, len_frm);
if(len_new)
new_frame_num++;
}
if(FIFO_WriteMode == WRITE_NOT_COMPLETE_FRAME)
{
len_new = PartialDataIntoFIFO(BufIn, Len, new_frame_num);
}
if(FIFO_WriteMode == WRITE_BY_LENGTH)
{
len_new = PutDataIntoFIFO(BufIn, Len);
if(len_new)
new_frame_num++;
}
if(new_frame_num)
{
wFrameNum += new_frame_num;
if(ReadFlagEnable && (wFrameNum >= wFrmNumToRead))
SetEvent(hEventRead);
if(WriteFlagEnable && (wFrameNum > wFrmNumToWrite))
ResetEvent(hEventWrite);
}
LeaveCriticalSection(&FIFO_operation);
return len_new;
}
DWORD CFifo::ReadFIFO(char *BufOut, DWORD Len)
{
DWORD len_new, len_frm;
EnterCriticalSection(&FIFO_operation);
if(FIFO_ReadMode == READ_ENDFLAG_WITH_CRC)
{
len_frm = GetDataFromFIFO(BufTempOut);
len_new = FrameExtractor(BufOut, len_frm);
}
if(FIFO_ReadMode == READ_ENDFLAG_NO_CRC)
{
len_new = GetDataFromFIFO(BufOut);
}
if(FIFO_ReadMode == READ_BY_LENGTH)
{
len_new = GetDataFromFIFO(BufOut, Len);
}
if(len_new)
{
wFrameNum--;
if(ReadFlagEnable && (wFrameNum < wFrmNumToRead))
ResetEvent(hEventRead);
if(WriteFlagEnable && (wFrameNum <= wFrmNumToWrite))
SetEvent(hEventWrite);
}
LeaveCriticalSection(&FIFO_operation);
return len_new;
}
DWORD CFifo::PutDataIntoFIFO(char *BufIn, DWORD Len)
{
DWORD Len_tmp = Len;
char *ptr_tmp = FIFO_Base + nPtr_W;
DWORD Len1 = FIFO_Len - nPtr_W + 1;
if(GetRoomLeft() < Len_tmp)
return 0;
if(Len1 > Len_tmp)
{
nPtr_W += Len;
while(Len_tmp--)
*ptr_tmp++ = *BufIn++;
}
else
{
Len_tmp -= Len1;
nPtr_W = Len_tmp;
while(Len1--)
*ptr_tmp++ = *BufIn++;
ptr_tmp = FIFO_Base;
while(Len_tmp--)
*ptr_tmp++ = *BufIn++;
}
return Len;
}
DWORD CFifo::PartialDataIntoFIFO(char *BufIn, DWORD Len, DWORD &FrmNum)
{
DWORD i;
char *ptr_s = BufIn;
DWORD len_r = 0;
DWORD len_t = 0;
DWORD len_n = 0;
static BOOL del_frm = FALSE;
for(i = 0; i < Len; i++)
{
len_n++;
if(*(BufIn + i) == cEndFlag)
{
if(!del_frm)
{
len_t = PutDataIntoFIFO(ptr_s, len_n);
if(len_t)
{
nPtr_W_inFrame = nPtr_W;
len_r += len_t;
FrmNum++;
}
else
{
nPtr_W = nPtr_W_inFrame;
del_frm = TRUE;
}
}
else
del_frm = FALSE;
ptr_s += len_n;
len_n = 0;
}
}
if(len_n && !del_frm)
{
len_t = PutDataIntoFIFO(ptr_s, len_n);
if(len_t)
len_r += len_t;
else
{
nPtr_W = nPtr_W_inFrame;
del_frm = TRUE;
}
}
return len_r;
}
DWORD CFifo::GetDataFromFIFO(char *BufOut, DWORD Len)
{
DWORD Len_tmp = Len;
char *ptr_tmp = FIFO_Base + nPtr_R;
DWORD Len1 = FIFO_Len - nPtr_R + 1;
if(wFrameNum == 0)
return 0;
if(Len1 > Len_tmp)
{
nPtr_R += Len;
while(Len_tmp--)
*BufOut++ = *ptr_tmp++;
}
else
{
Len_tmp -= Len1;
nPtr_R = Len_tmp;
while(Len1--)
*BufOut++ = *ptr_tmp++;
ptr_tmp = FIFO_Base;
while(Len_tmp--)
*BufOut++ = *ptr_tmp++;
}
return Len;
}
DWORD CFifo::GetDataFromFIFO(char *BufOut)
{
DWORD Len_r = 0;
if(wFrameNum == 0)
return 0;
while(*(FIFO_Base + nPtr_R) != cEndFlag)
{
*BufOut++ = *(FIFO_Base + nPtr_R);
Len_r++;
if(nPtr_R++ >= FIFO_Len)
nPtr_R = 0;
}
*BufOut = *(FIFO_Base + nPtr_R);
Len_r++;
if(nPtr_R++ >= FIFO_Len)
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -