#include "SLP.h"
	
void SLPSendPacket(char * buf, uchar len1);
uchar bSLPMaster;
uchar nStation;
uchar SLPinputB;
uchar SLPoutputB;
uchar nCurStation;
uchar inputBuf[5];
uchar outputBuf[5];

uchar SendBuf[8];

uchar SLPMasterRecved;		//Ö÷»úÊÕµ½×Ó»ú»Ø¸´
unsigned int SLPSlaveCountOut;

unsigned int SLPLostPkt=0;			 // ¶ª°üÊýÁ¿

uchar SLPOKSign;
uchar SLPErrSign;

uchar SLPBCC(char * pBuf, uchar len1)
{
	uchar i;
	uchar BCC=0;
	for (i=0;i<len1;i++)
	{
		BCC += pBuf[i];
	}
	return BCC;
}

void SLPparsePacket(char * pRecvBuf, uchar len1)
{
	
	stSLPPacket * pPacket = (stSLPPacket *)pRecvBuf;
	if (len1 != sizeof(stSLPPacket)) return;
//	if (pPacket->ED != EDsign) return;
	if (pPacket->BCC != SLPBCC(pRecvBuf,len1-1)) return;
		if (bSLPMaster) //master
		{
				if (pPacket->ST ==ST_S) 
				{
					//check
					if (pPacket->Dst == nCurStation) {
						SLPMasterRecved=1;
						SLPLostPkt=0;
						 inputBuf[nCurStation] = pPacket->Data;
					}
				}
//				SLPoutputB = (inputBuf[1] &0x0f) | ((inputBuf[2] &0x0f) << 4);
				SLPoutputB = inputBuf[1];
		}else
		{	//slave 
			if (pPacket->ST==ST_M) 
			{
				//check
				stSLPPacket * pRplyPkt = (stSLPPacket *)SendBuf;		
				if (pPacket->Dst == nStation) {
					SLPoutputB = pPacket->Data;
					SLPSlaveCountOut=0;
					
					pRplyPkt->ST = ST_S;
					pRplyPkt->Dst = nStation;
					pRplyPkt->Data = SLPinputB;
					pRplyPkt->BCC = SLPBCC(SendBuf, sizeof(stSLPPacket)-1);
	//				pRplyPkt->ED = EDsign;
					
					SLPSendPacket(SendBuf,sizeof(stSLPPacket));
				}
		  }
	}
}

void SLPMasterSendPacket(void)
{

		stSLPPacket * pReqPkt = (stSLPPacket *)SendBuf;
		outputBuf[1]=SLPinputB ;//&0xf;
//		outputBuf[2] = (SLPinputB & 0xf0) >> 4;
		pReqPkt->ST = ST_M;
		pReqPkt->Dst = nCurStation;
		pReqPkt->Data = outputBuf[nCurStation]; ;
		pReqPkt->BCC = SLPBCC(SendBuf, sizeof(stSLPPacket)-1);
//		pReqPkt->ED = EDsign;
		
		SLPSendPacket(SendBuf,sizeof(stSLPPacket));	
}
void SLPProcess(void)
{
	static int nCount =0;
			if (bSLPMaster) //master
		{
			if ( (nCount & 0x3f) == 0 ) 
			{			//time up
				if (SLPMasterRecved) {
//				SLPMasterRecved=0;
						SLPOKSign = 1;
						if (SLPErrSign) SLPErrSign--;
				
				}else {
					SLPLostPkt++;
					if (SLPLostPkt > 10) {
						SLPErrSign=20;
						SLPOKSign = 0;
					}
				}
				if (nStation >0) {
					nCurStation++;
					if (nCurStation > nStation) {
						nCurStation =1;
					}
					SLPMasterRecved=0;
					SLPMasterSendPacket();
				}
			}				
		}else
		{
			SLPSlaveCountOut ++;
			if (SLPSlaveCountOut >200)  		// 20mS
			{
					SLPErrSign=100;
			}else {
				if (SLPErrSign) SLPErrSign--;
			}
		}
	nCount++;			
}