protocol.cpp

一个完整的RTU程序源码,用DOS平台,支持16串口,在天津港用的很多,8个规约103,modbus,cdt,1801,u4f

#include "sc_cfg.h"
#include "common.h"
#include "class.h"
#include "extern.h"

const INT8U crctable[] = {
	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,
	0xE0,0xE7,0xEE,0xE9,0xFC,0xFB,0xF2,0xF5,0xD8,0xDF,0xD6,0xD1,0xC4,0xC3,0xCA,0xCD,
	0x90,0x97,0x9E,0x99,0x8C,0x8B,0x82,0x85,0xA8,0xAF,0xA6,0xA1,0xB4,0xB3,0xBA,0xBD,
	0xC7,0xC0,0xC9,0xCE,0xDB,0xDC,0xD5,0xD2,0xFF,0xF8,0xF1,0xF6,0xE3,0xE4,0xED,0xEA,
	0xB7,0xB0,0xB9,0xBE,0xAB,0xAC,0xA5,0xA2,0x8F,0x88,0x81,0x86,0x93,0x94,0x9D,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,
	0x89,0x8E,0x87,0x80,0x95,0x92,0x9B,0x9C,0xB1,0xB6,0xBF,0xB8,0xAD,0xAA,0xA3,0xA4,
	0xF9,0xFE,0xF7,0xF0,0xE5,0xE2,0xEB,0xEC,0xC1,0xC6,0xCF,0xC8,0xDD,0xDA,0xD3,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,
	0xAE,0xA9,0xA0,0xA7,0xB2,0xB5,0xBC,0xBB,0x96,0x91,0x98,0x9F,0x8A,0x8D,0x84,0x83,
	0xDE,0xD9,0xD0,0xD7,0xC2,0xC5,0xCC,0xCB,0xE6,0xE1,0xE8,0xEF,0xFA,0xFD,0xF4,0xF3
};

const INT8U auchhi[] = {
	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81,
	0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
	0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01,
	0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,
	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81,
	0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,
	0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01,
	0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,
	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81,
	0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
	0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01,
	0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
	0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81,
	0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,
	0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01,
	0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,
	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81,
	0x40
} ;
//Table of CRC values for low–order byte */

const INT8U auchlo[] = {
	0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7, 0x05, 0xC5, 0xC4,
	0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09,
	0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A, 0x1E, 0xDE, 0xDF, 0x1F, 0xDD,
	0x1D, 0x1C, 0xDC, 0x14, 0xD4, 0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3,
	0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3, 0xF2, 0x32, 0x36, 0xF6, 0xF7,
	0x37, 0xF5, 0x35, 0x34, 0xF4, 0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A,
	0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29, 0xEB, 0x2B, 0x2A, 0xEA, 0xEE,
	0x2E, 0x2F, 0xEF, 0x2D, 0xED, 0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26,
	0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60, 0x61, 0xA1, 0x63, 0xA3, 0xA2,
	0x62, 0x66, 0xA6, 0xA7, 0x67, 0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F,
	0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68, 0x78, 0xB8, 0xB9, 0x79, 0xBB,
	0x7B, 0x7A, 0xBA, 0xBE, 0x7E, 0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5,
	0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71, 0x70, 0xB0, 0x50, 0x90, 0x91,
	0x51, 0x93, 0x53, 0x52, 0x92, 0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C,
	0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B, 0x99, 0x59, 0x58, 0x98, 0x88,
	0x48, 0x49, 0x89, 0x4B, 0x8B, 0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C,
	0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42, 0x43, 0x83, 0x41, 0x81, 0x80,
	0x40
};

CProtocol::CProtocol(INT8U portno)
{
	myportno = portno;
}

INT8U CProtocol::get_crc8_code(INT8U *buf, INT8U len)
{
	INT8U crc = 0;

	for (INT8U i = 0; i < len; i++)
		crc =	crctable[buf[i] ^ crc];
	crc = ~crc;

	return (crc);
}

INT16U CProtocol::get_crc16_code(INT8U *msg, INT8U len)
{
	INT8U uindex;
	INT8U uchhi=0xff;
	INT8U uchlo=0xff;
	while (len--) {
		uindex = uchhi ^ *msg++;
		uchhi = uchlo ^ auchhi[uindex];
		uchlo = auchlo[uindex];
	}
	return (uchhi << 8 | uchlo);
}

INT8U CProtocol::checksum(INT8U *buf, INT8U len)
{
	INT8U temp=0;

	for (INT8U i = 0; i < len; i++) temp += buf[i];
	return (temp);
}

int CProtocol::get_yc_dot(INT16U dotno)
{
	return(dbdata.Yc[dotno]);
}

INT16U CProtocol::get_yx_16dot(INT16U dotno)
{
	return(dbdata.Yx[dotno]);
}

INT16U CProtocol::get_yx_dot(INT16U dotno)
{
	INT16U value;

	value = dbdata.Yx[dotno / 16];
	value = (value >> (dotno % 16)) & 0x1;
	return(value);
}

INT32U CProtocol::get_ym_dot(INT16U dotno)
{
	return(dbdata.Ym[dotno]);
}

void CProtocol::yx_update_db(INT16U dotno, INT16U value)
{
	if (value & 0x01)
		dbdata.Yx[dotno / 16] |= 1 << (dotno % 16);
	else dbdata.Yx[dotno / 16] &= ~(1 << (dotno % 16));
}

void CProtocol::yc_update_db(INT16U dotno, INT16U value)
{
	dbdata.Yc[dotno] = value;
}

void CProtocol::ym_update_db(INT16U dotno, INT32U value)
{
	dbdata.Ym[dotno] = value;
}

// this member function is for the protocol without yxbw or soe
void CProtocol::ProtocolProcessYX(int orderno, INT8U val)
{
	soe_record_t soe;
	yxbw_record_t yxbw;
	sclock sclk;
	
	if (get_yx_dot(orderno) ^ val) {
		yx_update_db(orderno, val);
		
		soe.status_switch_no = orderno & 0xfff;
		if (val)
			soe.status_switch_no |= 0x8000;	// 0x80:0->1  0x00:1->0
		else soe.status_switch_no &= 0x7fff;

		GetClock(&sclk);
		soe.day = sclk.day;
		soe.hour = sclk.hour;
		soe.minute = sclk.minute;
		soe.second = sclk.second;
		soe.msecond = sclk.msecond;

		insert_soe(&soe);

		yxbw.func_code = orderno >> 5;
		int loc = ((orderno & 0xffe) >> 4);
		yxbw.yx_code[0] = dbdata.Yx[loc];
		yxbw.yx_code[1] = dbdata.Yx[loc + 1];

		insert_yx_bw(&yxbw);
	}
}

CMasterProtocol::CMasterProtocol(INT8U portno):CProtocol(portno)
{
	int i, j;
	YxDefine_t *pyx = NULL;
	YcDefine_t *pyc = NULL;
	YmDefine_t *pym = NULL;
	YkDefine_t *pyk = NULL;

	pyx_tbl = NULL;
	pyc_tbl = NULL;
	pym_tbl = NULL;
	pyk_tbl = NULL;
	yx_num = 0;
	yc_num = 0;
	ym_num = 0;
	yk_num = 0;

	for (i = 0; i < GetTotalYxNum(); i++) {
		pyx = GetYxDefine(i);
		if (pyx->portno == myportno)
			yx_num++;
	}
	if (yx_num > 0) {
		if ((pyx_tbl = new INT16U[yx_num]) == NULL) ErrorExit("pyx_tbl memory alloc error in port%d", myportno);
		for (i = 0, j = 0; i < GetTotalYxNum(); i++) {
			pyx = GetYxDefine(i);
			if (pyx->portno == myportno)
				pyx_tbl[j++] = i;
		}
	}

	for (i = 0; i < GetTotalYcNum(); i++) {
		pyc = GetYcDefine(i);
		if (pyc->portno == myportno)
			yc_num++;
	}
	if (yc_num > 0) {
		if ((pyc_tbl = new INT16U[yc_num]) == NULL) ErrorExit("pyc_tbl memory alloc error in port%d", myportno);
		for (i = 0, j = 0; i < GetTotalYcNum(); i++) {
			pyc = GetYcDefine(i);
			if (pyc->portno == myportno)
				pyc_tbl[j++] = i;
		}
	}

	for (i = 0; i < GetTotalYmNum(); i++) {
		pym = GetYmDefine(i);
		if (pym->portno == myportno)
			ym_num++;
	}
	if (ym_num > 0) {
		if ((pym_tbl = new INT16U[ym_num]) == NULL) ErrorExit("pym_tbl memory alloc error in port%d", myportno);
		for (i = 0, j = 0; i < GetTotalYmNum(); i++) {
			pym = GetYmDefine(i);
			if (pym->portno == myportno)
				pym_tbl[j++] = i;
		}
	}

	for (i = 0; i < GetTotalYkNum(); i++) {
		pyk = GetYkDefine(i);
		if (pyk->portno == myportno)
			yk_num++;
	}
	if (yk_num > 0) {
		if ((pyk_tbl = new INT16U[yk_num]) == NULL) ErrorExit("pyk_tbl memory alloc error in port%d", myportno);
		for (i = 0, j = 0; i < GetTotalYkNum(); i++) {
			pyk = GetYkDefine(i);
			if (pyk->portno == myportno)
				pyk_tbl[j++] = i;
		}
	}

}

CMasterPollingProtocol::CMasterPollingProtocol(INT8U portno):CMasterProtocol(portno)
{
	DevStartAddr = GetPortSet(myportno)->DevStartAddr;
	DevEndAddr = GetPortSet(myportno)->DevEndAddr;

	dev_num = DevEndAddr - DevStartAddr + 1;
	if (dev_num > MAX_SLAVE) dev_num = MAX_SLAVE;

	CurrentQueryAddr = DevStartAddr;

	isLink = NULL;
	fail_count = NULL;

	if ((isLink = new INT8U[dev_num]) == NULL) ErrorExit("isLink memory alloc error in port%d", myportno);
	if ((fail_count = new INT8U[dev_num]) == NULL) ErrorExit("fail count memory alloc error in port%d", myportno);

	memset(isLink, FALSE, dev_num);
	memset(fail_count, 0, dev_num); // communicate
	QueryGap = 1000;
	GapTimer = get_mtime();
}

void CMasterPollingProtocol::deal()
{
	if (yc_num < 1 && yx_num < 1 && ym_num < 1 && yk_num < 1) return; // no sample object
	
	master_receive();

	PreProcess();

	if (!port_free(myportno)) return; //  uart transferring data
	
	if (!check_mtimeout(GapTimer, QueryGap)) return; //1 = 0.05s
	
	CommunicateProcess();
	
	clear_com_rece_buf(myportno);

	master_send();

	GapTimer = get_mtime();
}

void CMasterPollingProtocol::CommunicateProcess()
{
	INT8U Locate = CurrentQueryAddr - DevStartAddr;
	
	if (ANSWER == QueryStatus) {
		fail_count[Locate] = 0;
		isLink[Locate] = TRUE;
	}
	else if (QUERY == QueryStatus) {
		if (fail_count[Locate] > 3)
			isLink[Locate] = FALSE;
		else fail_count[Locate]++;
	}

	YxDefine_t *pyx;
	for (int i = 0; i < yx_num; i++) {
		pyx = GetYxDefine(pyx_tbl[i]);
		if (pyx->devno == CurrentQueryAddr && pyx->type == TYPE_COMM) {
			ProtocolProcessYX(pyx_tbl[i], isLink[Locate]);
		}
	}
}

void CMasterPollingProtocol::SetQueryGap(INT32U TimerGap)
{
	QueryGap = TimerGap;
}