protocol.cpp

来自「基于PC104平台」· C++ 代码 · 共 35 行

////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
//                 File name: protocol.cpp
//  This file define the functions used in new bb
////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
#include "class.h"
void CProtocol::putdata(BYTE data)
{
	dataque.buf[dataque.next++] = data&0xff;
	if (dataque.next >= dataque.size) dataque.next = 0;
	dataque.count++;
	if (dataque.count > dataque.size) {
		dataque.count = dataque.size;
		dataque.start++;
		if (dataque.start >= dataque.size) dataque.start = 0;
	}
}

void CProtocol::dropdata()
{
	if (dataque.count>0) {
		dataque.start++;
		if(dataque.start>=dataque.size)dataque.start=0;
		dataque.count--;
	}
}

unsigned int CProtocol::mod(unsigned int par1,unsigned int par2)
{
 if(par1>=par2)return(par1-par1/par2*par2);
 else return(par1);
}

//////////////////////////////////////////////////////////////////////////////////////
//The end of protocol.cpp
//////////////////////////////////////////////////////////////////////////////////////