QT系统集成组

// CModbus_TcpS.cpp: implementation of the CModbus_TcpS class.

//

//MODBUS_tcp  ת????Լ

//#include "stdafx.h"

#include "se_log.h"

#include "se_btl.h"

#include "L02ATS_modbus_tcps.h"

//#include <windows.h>

#ifdef _DEBUG

#undef THIS_FILE

static char THIS_FILE[]=__FILE__;

#define new DEBUG_NEW

#endif

//////////////////////////////////////////////////////////////////////

// Construction/Destruction

//////////////////////////////////////////////////////////////////////

CModbus_TcpS::~CModbus_TcpS()

{

}

void CModbus_TcpS::Init(S_PROTOCOLCFG * pcfg )

{

	PRawCtrl	=	pcfg->PRawCtrl;

	pRxBuf		=	pcfg->pRxBuf;

	pTxBuf		=	pcfg->pTxBuf;

	pCmdMem		=	pcfg->pCmdMem;

	pRtu		=	pcfg->pRtu;

	pLink		=	pcfg->pLink;

	pTable		=	pcfg->pTable;

	pZfDataCtrl	=	pcfg->pZfDataCtrl;

//	pHis		=	pcfg->pHis;

	m_RcvTimeOuts = pLink->GetRxTimeouts();		//?ȴ????

	if (m_RcvTimeOuts <= 0)	m_RcvTimeOuts = 5;

	m_LastRecvTime = GetNowSecond();

}

//??Լ???͹???

sint32	CModbus_TcpS::TxProc()

{

	ProcCmd();

	return 1;

}

/***********************************************************

?????

***********************************************************/

uint8 CModbus_TcpS::ProcCmd()

{

	sint32 rtuno			=	pLink->GetRtuNo();

	unsigned char rtuaddr	=	pRtu->GetRtuAddr(rtuno);

	//??????????򵥰?????ɾ??????Ϊû??ң?ط?У

	if(pCmdMem->GetResultNum(rtuno)<=0)

		return FALSE;

	S_RAWCMD rawcmd;

	if(pCmdMem->GetAResult(rtuno,&rawcmd)==0)

		return FALSE;

	while(pCmdMem->GetResultNum(rtuno)>0)

	{

		if(pCmdMem->GetAResult(rtuno,&rawcmd)==0)

			break;

		switch(rawcmd.type)

		{

		case DC_K_CMDRET_DOOPER:

		default: //?????????·????????

			pCmdMem->DelAResult(rtuno);

			break;

		}

	}

	return FALSE;

}

//ң??

void CModbus_TcpS::ProcYKCmd(uint16 YaoKongNo,uint16 YkStatus)

{

	sint32 rtuno=pLink->GetRtuNo();

	unsigned char rtuaddr=pRtu->GetRtuAddr(rtuno);

	//??????ֱ??ѹ??????ң?ض???

	S_DO_CTL cmdinfo;

	S_RAWCMD  rawcmd;

	memset(&rawcmd,0,sizeof(S_RAWCMD));

	cmdinfo.funcCode = DC_K_CTL_DOEXE;

	cmdinfo.ptAddr = YaoKongNo+1;

	cmdinfo.ctlVal = YkStatus;

	cmdinfo.retCode = 0;

	rawcmd.type=DC_K_CMD_DOOPER;

	rawcmd.len=sizeof(cmdinfo);

	memcpy(rawcmd.data,&cmdinfo,sizeof(cmdinfo));

	if(pCmdMem->RptAZfCmd(rtuno,rawcmd)==0)

	{

		ReturnException(0x05,0x02);

		PrintLog(LOG_INFORMATION,"Ӧ??ң?????? ERROR (%d:%d)",YaoKongNo,YkStatus);

		return;

	}

	//?򵥷???һ??һ????????

	unsigned char buf[1024];

	int buflen =0;

    buf[buflen]=TransIdHi;  buflen++;

    buf[buflen]=TransIdLo;  buflen++;

    buf[buflen]=0; buflen++;

    buf[buflen]=0;  buflen++;

	buf[buflen]=0; buflen++;

	buf[buflen]=6; buflen++;

	buf[buflen]=rtuaddr; buflen++;

	buf[buflen]=5;  buflen++;//fun

	buf[buflen]=HIBYTE(YaoKongNo); buflen++; 

	buf[buflen]=LOBYTE(YaoKongNo); buflen++; 

	buf[buflen]=HIBYTE(YkStatus); buflen++; 

	buf[buflen]=LOBYTE(YkStatus); buflen++; 

	PrintLog(LOG_INFORMATION,"Ӧ??ң?????? (%d:%d)",YaoKongNo,YkStatus);

	pTxBuf->Write(buf,buflen);

	pLink->SetCommStatus(CMST_NORMAL);

}

void CModbus_TcpS::ReturnException(uint8 func,uint8 expCode)		//func????????????  expCode???????ص??쳣??

{

	sint32 rtuno			=	pLink->GetRtuNo();

	unsigned char rtuadd	=	pRtu->GetRtuAddr(rtuno);

	unsigned char buf[20]={0};

	sint32 buflen =0;

    buf[buflen]=TransIdHi;  buflen++;

    buf[buflen]=TransIdLo;  buflen++;

    buf[buflen]=0; buflen++;

    buf[buflen]=0;  buflen++;

	buf[buflen]=0; buflen++;

	buf[buflen]=3; buflen++;

	buf[buflen]=rtuadd; buflen++;		//??Ԫ??ʶ????rtuվַ

	buf[buflen]=func|0x80;  buflen++;//fun	??Ӧ??????=????????+0x80

	buf[buflen]=expCode; buflen++;		//??Ӧ?ĵ??е??쳣???????쳣??

	pTxBuf->Write(buf,buflen);

	pLink->SetCommStatus(CMST_NORMAL);

}

//????AI????

sint32	CModbus_TcpS::SendMeasure(uint16 RegOffset,uint16 RegNum)

{

	sint32 rtuno	=	pLink->GetRtuNo();

	uint8 rtuadd	=	pRtu->GetRtuAddr(rtuno);

	sint32 startno = RegOffset+1;

	S_RDB_ZFYc *ycinfo;

	CEasyList *yclist=pZfDataCtrl->GetYcStructList();

	sint32 ycnum=yclist->GetListLen();

	if(yclist==NULL || ycnum<0 || RegNum*2>250)

	{

		ReturnException(0x03,0x02);

		return 0;

	}

	ycinfo = (S_RDB_ZFYc *)((*yclist)[ycnum-1]);

	if(ycinfo->YcNo < startno || ycinfo->YcNo<(RegOffset+RegNum))

	{

		PrintLog(LOG_ERROR,"ת?????ݴ???, MAX YCNO=%d",ycinfo->YcNo);

		ReturnException(0x03,0x02);

		return 0;

	}

	uint8 buf[300]={0};

	uint16 dl = RegNum*2+3;

	sint32 buflen =0;

    buf[buflen]=TransIdHi;  buflen++;

    buf[buflen]=TransIdLo;  buflen++;

    buf[buflen]=0; buflen++;

    buf[buflen]=0;  buflen++;

	buf[buflen]=dl/256; buflen++;

	buf[buflen]=dl%256; buflen++;

	buf[buflen]=rtuadd; buflen++;

	buf[buflen]=3;  buflen++;//fun

	buf[buflen] = RegNum * 2; buflen++;

	sint32 j;

	for(j=0;j<yclist->GetListLen();j++)

	{

		ycinfo=(S_RDB_ZFYc *)((*yclist)[j]);

		if(ycinfo->YcNo> (RegNum+RegOffset))break;

		if(ycinfo->YcNo<startno)

			continue;

		buf[(ycinfo->YcNo-startno)*2+buflen] = ((sint32)(ycinfo->Val))/256; 

		buf[(ycinfo->YcNo-startno)*2+1+buflen] = ((sint32)(ycinfo->Val))%256; 

		ycinfo->OldVal=ycinfo->Val;///**Modified by WYF20191112 ???Ӹ?????ֵ+??仯??־**/

		UNSETBIT(ycinfo->qds, PTMSK_AI_CHANGE );//FEP	

//		ycinfo->chgFlag = 0x00;//WIN		

	}

	PrintLog(LOG_INFORMATION,"Ӧ??????03: ??ʼ??ַ%d - ????%d)",RegOffset,RegNum);

	pTxBuf->Write(buf,buflen+RegNum*2);

	pLink->SetCommStatus(CMST_NORMAL);

	return 1;

}

//????DI????

sint32	CModbus_TcpS::SendDiOne(uint16 startAddr,uint16 Num)		

{

	sint32 rtuno	=	pLink->GetRtuNo();				//??ȡrtu???

	uint8 rtuadd	=	pRtu->GetRtuAddr(rtuno);		//??ȡrtuվַ

	sint32 startno = startAddr+1;

	S_RDB_ZFYx *yxinfo;

	CEasyList *yxlist=pZfDataCtrl->GetYxStructList();	//??ȡǰ??ת??????.ң?Žṹ?б?

	if(yxlist == NULL || Num>2000)//250*8		ǰ??ת??ң?Žṹ?б?Ϊ??||????ļĴ???????????

	{

		ReturnException(0x01,0x02);		//0x01:????????  0x02:???ص??쳣??

		return 0;

	}

	sint32 yxnum=yxlist->GetListLen();

	if(yxnum<0 )

	{

		ReturnException(0x01,0x02);

		return 0;

	}

	yxinfo = (S_RDB_ZFYx *)((*yxlist)[yxnum-1]);

	if(yxinfo->YxNo < startno || yxinfo->YxNo<(startAddr+Num))		//ǰ??ת??ң???б???????ң?ű??С????ʼ?????????ַ

	{

		PrintLog(LOG_ERROR,"ת?????ݴ???, MAX YXNO=%d,startno=%d,Num=%d",yxinfo->YxNo,startno,Num);

		ReturnException(0x01,0x02);

		return 0;

	}

	uint8 buf[300]={0};

	sint32 buflen =0;

	sint32 bytecount = (Num+7)/8;

	uint16 dl = bytecount+3;

    buf[buflen]=TransIdHi;  buflen++;

    buf[buflen]=TransIdLo;  buflen++;

    buf[buflen]=0; buflen++;

    buf[buflen]=0;  buflen++;

	buf[buflen]=dl/256; buflen++;				//Length????(Length?????ֶκ???İ????ֽڡ?Ҳ????3 + 2 * N Data(as requested)?ֶΰ??????ֽ?)

	buf[buflen]=dl%256; buflen++;				//Length????

	buf[buflen]=rtuadd; buflen++;				//??Ԫ??ʶ(RTUվַ)

	buf[buflen]=0x01;  buflen++;//fun			//??????

	buf[buflen]=bytecount; buflen++;			//Data?????ݳ???

	sint32 j,byteIdx,bitIdx;		

	for(j=0;j<yxlist->GetListLen();j++)

	{

		yxinfo=(S_RDB_ZFYx *)((*yxlist)[j]);

		if(yxinfo->YxNo> (Num+startAddr))break;

		if(yxinfo->YxNo<startno)	

			continue;

		if(yxinfo->Val == 1)

		{

			byteIdx = (yxinfo->YxNo-startno)/8 + buflen;

			bitIdx  = (yxinfo->YxNo-startno)%8;

			buf[byteIdx] |= 1<<bitIdx; 

		}

		else{

			byteIdx = (yxinfo->YxNo-startno)/8 + buflen;

			bitIdx  = (yxinfo->YxNo-startno)%8;

			buf[byteIdx] &= (~(1<<bitIdx)) & 0xff; ///**Modified by WYF20180616 ???ƶ???ȡ??**/

//			buf[byteIdx] &= (~1<<bitIdx & 0xff); 

		}

		yxinfo->OldVal=yxinfo->Val;

		UNSETBIT(yxinfo->qds, PTMSK_DI_CHANGE );//FEP

//		yxinfo->chgFlag = 0x00;//WIN

	}

	PrintLog(LOG_INFORMATION,"Ӧ??????01: ??ʼ??ַ%d - ????%d)",startAddr,Num);

	pTxBuf->Write(buf,buflen+bytecount);

	pLink->SetCommStatus(CMST_NORMAL);

	return 1;

}

//??Լ???պ???

sint32	CModbus_TcpS::RxProc()

{

	sint32 rtuno		=	pLink->GetRtuNo();

	uint8 rtuaddr		=	pRtu->GetRtuAddr(rtuno);		//RTUվַ

	uint8  buf[512];

	sint32 buflen = 0 ,datalen = 0,datanum =0;

	sint32 nowTime = GetNowSecond();

	buflen=pRxBuf->GetReadableSize();

	if(buflen< 12)

	{

		if ((nowTime - m_LastRecvTime) >= m_RcvTimeOuts)

		{

			pLink->RegisterFrm(FRAME_RX_TIMEOUT);

			m_LastRecvTime = nowTime;

		}

		return 0;

	}

	m_LastRecvTime = nowTime;

	pLink->RegisterFrm(FRAME_RX_SUC);

	if(buflen>500)

		buflen=500;

	datalen = pRxBuf->Read(buf, buflen, DEF_BUFF_NOMOVE );

	sint32 framelen = buf[4]*256 + buf[5];

	if( (framelen+6)<=datalen) //?????㹻

	{

		if (buf[6]!= rtuaddr)//վַ????

		{

			pRxBuf->Move(datalen);

			return 0;

		}

		TransIdHi = buf[0];		//header??ͷ  ?????ʶ

		TransIdLo = buf[1];		//header??ͷ  ?????ʶ

		//????????????????

		if(buf[7] == 0x01)//????DI????

		{

			uint16 startAddr = buf[8]*256 + buf[9];		//??ʼ??ַ

			uint16 pntNum = buf[10]*256 + buf[11];		//?Ĵ???????

			SendDiOne(startAddr,pntNum);

		}

		else if (buf[7] == 0x02)//????????????

		{

			uint16 startAddr = buf[8] * 256 + buf[9];

			uint16 pntNum = buf[10] * 256 + buf[11];

			SendSwitch(startAddr, pntNum);

		}

		else if(buf[7]==0x03)//????AI????

		{

			uint16 startAddr = buf[8]*256 + buf[9];		

			uint16 pntNum	= buf[10]*256 + buf[11];	

			SendMeasure(startAddr,pntNum);

		}

		else if (buf[7] == 0x04) {	//??????CIOS?Ĵ???

			uint16 startAddr = buf[8] * 256 + buf[9];

			uint16 pntNum = buf[10] * 256 + buf[11];

			SendMeasureOne(startAddr,pntNum);

		}

		else if(buf[7]==0x05)//ң??

		{

			uint16 m_YaoKongNo = buf[8]*256 + buf[9];

			uint16 m_YkStatus	= buf[10]*256 + buf[11];

			ProcYKCmd(m_YaoKongNo,m_YkStatus);

		}

		else if(buf[7]==0x06)//ң??//WYF 20190110

		{

			uint16 m_YaoKongNo = buf[8]*256 + buf[9];

			uint16 m_YkStatus	= buf[10]*256 + buf[11];

			ProcYTCmd(m_YaoKongNo,m_YkStatus);

		}//WYF 20190110

		else

			ReturnException(buf[7],0x01);//illegal function

		pRxBuf->Move(framelen+6);

	}

	return 1;

}

//ң??	//WYF 20190110

void CModbus_TcpS::ProcYTCmd(uint16 YaoKongNo,uint16 YkStatus)

{

	sint32 rtuno=pLink->GetRtuNo();

	unsigned char rtuaddr=pRtu->GetRtuAddr(rtuno);

	//??????ֱ??ѹ??????ң?ض???

	S_AO_CTL cmdinfo;

	S_RAWCMD  rawcmd;

	memset(&rawcmd,0,sizeof(S_RAWCMD));

	cmdinfo.funcCode = DC_K_CTL_AOEXE;

	cmdinfo.ptAddr = YaoKongNo+1;

	cmdinfo.ptVal = YkStatus;

	cmdinfo.retCode = 0;

	rawcmd.type=DC_K_CMD_AOOPER;

	rawcmd.len=sizeof(cmdinfo);

	memcpy(rawcmd.data,&cmdinfo,sizeof(cmdinfo));

	if(pCmdMem->RptAZfCmd(rtuno,rawcmd)==0)

	{

		ReturnException(0x06,0x02);

		PrintLog(LOG_INFORMATION,"Ӧ??ң?????? ERROR (%d:%d)",YaoKongNo,YkStatus);

		return;

	}

	//?򵥷???һ??һ????????

	unsigned char buf[1024];

	int buflen =0;

    buf[buflen]=TransIdHi;  buflen++;

    buf[buflen]=TransIdLo;  buflen++;

    buf[buflen]=0; buflen++;

    buf[buflen]=0;  buflen++;

	buf[buflen]=0; buflen++;

	buf[buflen]=6; buflen++;

	buf[buflen]=rtuaddr; buflen++;

	buf[buflen]=6;  buflen++;//fun

	buf[buflen]=HIBYTE(YaoKongNo); buflen++; 

	buf[buflen]=LOBYTE(YaoKongNo); buflen++; 

	buf[buflen]=HIBYTE(YkStatus); buflen++; 

	buf[buflen]=LOBYTE(YkStatus); buflen++; 

	PrintLog(LOG_INFORMATION,"Ӧ??ң?????? (%d:%d)",YaoKongNo,YkStatus);

	pTxBuf->Write(buf,buflen);

	pLink->SetCommStatus(CMST_NORMAL);

}

//WYF 20190110

//??????CIOS?Ĵ???

sint32 CModbus_TcpS::SendMeasureOne(uint16 RegOffset, uint16 RegNum) {

	sint32 rtuno = pLink->GetRtuNo();

	uint8 rtuadd = pRtu->GetRtuAddr(rtuno);

	sint32 startno = RegOffset + 1;

	S_RDB_ZFYc *ycinfo;

	CEasyList *yclist = pZfDataCtrl->GetYcStructList();

	sint32 ycnum = yclist->GetListLen();

	if (yclist == NULL || ycnum<0 || RegNum > 2000) {

		ReturnException(0x04, 0x02);

		return 0;

	}

	ycinfo = (S_RDB_ZFYc *)((*yclist)[ycnum - 1]);

	if (ycinfo->YcNo < startno || ycinfo->YcNo<(RegOffset + RegNum)) {

		PrintLog(LOG_ERROR, "ת?????ݴ???, MAX YCNO=%d", ycinfo->YcNo);

		ReturnException(0x04, 0x02);

		return 0;

	}

	uint8 buf[4009] = { 0 };

	uint16 dl = RegNum * 2 + 3;

	sint32 buflen = 0;

	buf[buflen] = TransIdHi;  buflen++;

	buf[buflen] = TransIdLo;  buflen++;

	buf[buflen] = 0; buflen++;

	buf[buflen] = 0;  buflen++;

	buf[buflen] = dl / 256; buflen++;

	buf[buflen] = dl % 256; buflen++;

	buf[buflen] = rtuadd; buflen++;

	buf[buflen] = 4;  buflen++;//fun

	if (RegNum * 2 > 250) {

		buf[buflen] = 0; buflen++;

	} else {

		buf[buflen] = RegNum * 2; buflen++;

	}

	sint32 j;

	for (j = 0; j<yclist->GetListLen(); j++) {

		ycinfo = (S_RDB_ZFYc *)((*yclist)[j]);

		if (ycinfo->YcNo>(RegNum + RegOffset))break;

		if (ycinfo->YcNo<startno)

			continue;

		buf[(ycinfo->YcNo - startno) * 2 + buflen] = ((sint32)(ycinfo->Val)) / 256;

		buf[(ycinfo->YcNo - startno) * 2 + 1 + buflen] = ((sint32)(ycinfo->Val)) % 256;

		ycinfo->OldVal = ycinfo->Val;///**Modified by WYF20191112 ???Ӹ?????ֵ+??仯??־**/

		UNSETBIT(ycinfo->qds, PTMSK_AI_CHANGE);//FEP	

		//		ycinfo->chgFlag = 0x00;//WIN		

	}

	PrintLog(LOG_INFORMATION, "Ӧ??????04: ??ʼ??ַ%d - ????%d)", RegOffset, RegNum);

	pTxBuf->Write(buf, buflen + RegNum * 2);

	pLink->SetCommStatus(CMST_NORMAL);

	return 1;

}

//????????????

sint32 CModbus_TcpS::SendSwitch(uint16 startAddr, uint16 Num) {

	sint32 rtuno = pLink->GetRtuNo();				//??ȡrtu???

	uint8 rtuadd = pRtu->GetRtuAddr(rtuno);		//??ȡrtuվַ

	sint32 startno = startAddr + 1;

	S_RDB_ZFYx *yxinfo;

	CEasyList *yxlist = pZfDataCtrl->GetYxStructList();	//??ȡǰ??ת??????.ң?Žṹ?б?

	if (yxlist == NULL || Num>2000)//250*8		ǰ??ת??ң?Žṹ?б?Ϊ??||????ļĴ???????????

	{

		ReturnException(0x02, 0x02);		//0x02:????????  0x02:???ص??쳣??

		return 0;

	}

	sint32 yxnum = yxlist->GetListLen();

	if (yxnum<0) {

		ReturnException(0x02, 0x02);

		return 0;

	}

	yxinfo = (S_RDB_ZFYx *)((*yxlist)[yxnum - 1]);

	if (yxinfo->YxNo < startno || yxinfo->YxNo<(startAddr + Num))		//ǰ??ת??ң???б???????ң?ű??С????ʼ?????????ַ

	{

		PrintLog(LOG_ERROR, "ת?????ݴ???, MAX YXNO=%d,startno=%d,Num=%d", yxinfo->YxNo, startno, Num);

		ReturnException(0x02, 0x02);

		return 0;

	}

	uint8 buf[300] = { 0 };

	sint32 buflen = 0;

	sint32 bytecount = (Num + 7) / 8;

	uint16 dl = bytecount + 3;

	buf[buflen] = TransIdHi;  buflen++;

	buf[buflen] = TransIdLo;  buflen++;

	buf[buflen] = 0; buflen++;

	buf[buflen] = 0;  buflen++;

	buf[buflen] = dl / 256; buflen++;				//Length????(Length?????ֶκ???İ????ֽڡ?Ҳ????3 + 2 * N Data(as requested)?ֶΰ??????ֽ?)

	buf[buflen] = dl % 256; buflen++;				//Length????

	buf[buflen] = rtuadd; buflen++;				//??Ԫ??ʶ(RTUվַ)

	buf[buflen] = 0x02;  buflen++;//fun			//??????

	buf[buflen] = bytecount; buflen++;			//Data?????ݳ???

	sint32 j, byteIdx, bitIdx;

	for (j = 0; j<yxlist->GetListLen(); j++) {

		yxinfo = (S_RDB_ZFYx *)((*yxlist)[j]);

		if (yxinfo->YxNo>(Num + startAddr))break;

		if (yxinfo->YxNo<startno)

			continue;

		if (yxinfo->Val == 1) {

			byteIdx = (yxinfo->YxNo - startno) / 8 + buflen;

			bitIdx = (yxinfo->YxNo - startno) % 8;

			buf[byteIdx] |= 1 << bitIdx;

		} else {

			byteIdx = (yxinfo->YxNo - startno) / 8 + buflen;

			bitIdx = (yxinfo->YxNo - startno) % 8;

			buf[byteIdx] &= (~(1 << bitIdx)) & 0xff; ///**Modified by WYF20180616 ???ƶ???ȡ??**/

			//			buf[byteIdx] &= (~1<<bitIdx & 0xff); 

		}

		yxinfo->OldVal = yxinfo->Val;

		UNSETBIT(yxinfo->qds, PTMSK_DI_CHANGE);//FEP

		//		yxinfo->chgFlag = 0x00;//WIN

	}

	PrintLog(LOG_INFORMATION, "Ӧ??????02: ??ʼ??ַ%d - ????%d)", startAddr, Num);

	pTxBuf->Write(buf, buflen + bytecount);

	pLink->SetCommStatus(CMST_NORMAL);

	return 1;

}

//??ȡ??ǰʱ??

sint32 CModbus_TcpS::GetNowSecond()

{

	CSeTime     SE_T;

	TCriterionTime tmptime;//sint32

	SE_T.GetNow(&tmptime);

	return (sint32)tmptime;

}

//??Լ???󴴽?????

#ifdef __unix

extern "C" CProtocol* CreateProtocol(char *defpara)

#else

extern "C" __declspec(dllexport)  CProtocol* CreateProtocol(char *defpara)

#endif

{

	CProtocol *pEpv = new CModbus_TcpS;

	return pEpv;

}