IEC60870-cdt规约

// ProtocolBody.cpp: implementation of the CProtocolBody class. // ////////////////////////////////////////////////////////////////////// /*----------------------------------------------------------------------- * 文件名 : ProtocolBody.cpp * 说明 : 规约类Cdt92的实现. * 版本 : 3.0.0.0 * 最终修改日期：2005-6-21 *-----------------------------------------------------------------------*/ #include "stdafx.h" #include "ProtocolCdt.h" #include "ProtocolBody.h" #include <math.h> #include <string.h> #ifdef _DEBUG #undef THIS_FILE static char THIS_FILE[]=__FILE__; #define new DEBUG_NEW #endif ////////////////////////////////////////////////////////////////////// // Construction/Destruction ////////////////////////////////////////////////////////////////////// BYTE CProtocolBody::BchTable[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, 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 }; #define RECEIVE_BUF_LEN 2058//1024 #define BB_PACKET_LENGTH 6 #define BB_SYN_TAG_BIT 0x01 #define BB_CON_TAG_BIT 0x02 #define BB_CONTINUE_ERR_NUM_LIMIT 0x02 CProtocolBody::CProtocolBody() { m_TolLeftNum = 0; m_Ts2 = 3600*1000; m_exeReply.m_optFunc = S_ZC; m_soeOnly[0].m_soeObject = 0; GetLocalTime( &m_soeOnly[0].m_soeTime ); m_soeOnly[0].m_val = 0; for ( int i = 1; i < BB_SOE_KEEP_LENGTH-1; i++) { m_soeOnly[i].m_soeObject = -1; memcpy( &m_soeOnly[i].m_soeTime , &m_soeOnly[0].m_soeTime , sizeof(SYSTEMTIME) ); m_soeOnly[i].m_val = 0;//lgh } memset(m_ykReply, 0 , 2*sizeof(YkReplyOnlyStruct) ); GetLocalTime( &m_ykReply[0].m_ykReplyTime ); memcpy( &m_ykReply[1].m_ykReplyTime , &m_ykReply[0].m_ykReplyTime , sizeof(SYSTEMTIME) ); memset(m_ytReply, 0 , 2*sizeof(YtReplyStruct) ); GetLocalTime( &m_ytReply[0].m_ytReplyTime ); memcpy( &m_ytReply[1].m_ytReplyTime , &m_ytReply[0].m_ytReplyTime , sizeof(SYSTEMTIME) ); m_sycWord[0] = 0xEB; m_sycWord[1] = 0x90; m_sycWord[2] = 0xEB; m_sycWord[3] = 0x90; m_sycWord[4] = 0xEB; m_sycWord[5] = 0x90; m_nYcFrameType = 0; m_frameType = 0; m_FrameCount = 0; m_isYxFrame = 0; m_yxInsert.insertYXcnt = 0; m_ykInsert.insertYXcnt = 0; m_count = 0; m_dwErrRateTime = 0; // m_dLastKeepTime = 0; } CProtocolBody::~CProtocolBody() { } void CProtocolBody::MasterRec() { if(rtu_index<0 || chan_id<0) return; scada_RTUVal* pv=(scada_RTUVal*)pRTU_t->data; scada_chanVal* pChanv=(scada_chanVal*)pChanVal_t->data; // DWORD ID; // if(!EVT_GetTableID("scada","RTU",ID)) return; // if ((pRTU = (MEMTABLE*)EVT_GetTableAdd(ID&0xffff))==NULL) return; // scada_RTU* pc=(scada_RTU*)pRTU->data; BOOL bRtuStatus = FALSE; memset(&m_recProcControl,0,sizeof(RecProcControl)); DWORD id=0; //if(rtu_index==5) // TRACE("%d,%d\n",rtu_index,databuf.recLen); // if(!EVT_GetTableID("scada","RTUVal",id)) return; DWORD RTotalNo=0; RTotalNo=pChanv[chan_id].RTotalNum; WORD TmpRecLen = databuf.recLen; // RTotalNo += databuf.recLen/6; //lgh // pv[rtu_index].RTotalNum=RTotalNo; //lgh BYTE *packet_ptr = NULL; int start=0, old_m_rbuf_count = databuf.recLen; // int conCount=0; //lgh CTime ltime; // scada_RTUVal* pRtu=(scada_RTUVal*)pRTU_t->data; // if(databuf.recLen>0) // { // ltime=CTime::GetCurrentTime(); // memcpy(&m_dLastKeepTime,&ltime,sizeof(DWORD)); // } // else // { // DWORD lt=0; // ltime=CTime::GetCurrentTime(); // memcpy(&lt,&ltime,sizeof(DWORD)); // if((lt-m_dLastKeepTime)>6) // pv[rtu_index].State = 0; // // } if( (databuf.recLen > RECEIVE_BUF_LEN ) ) { databuf.recLen = 0; return; } p_data.idle_num =0; p_data.no_rec_num=0; while ( databuf.recLen >= BB_PACKET_LENGTH ) { start = old_m_rbuf_count - databuf.recLen; if( (start<0) || (start >= RECEIVE_BUF_LEN) ) break; packet_ptr = &databuf.recBuf[start]; if( HeadVerify( packet_ptr,databuf.recLen ) ) //核对同步头和 RTU模块地址 { m_yxInsert.insertYXcnt = 0; m_ykInsert.insertYXcnt = 0; m_recProcControl.m_synControlTag = BB_SYN_TAG_BIT; m_recProcControl.m_flagControl = TRUE; //控制字待检测 m_recProcControl.m_continueErrNum = 0; databuf.recLen -= BB_PACKET_LENGTH; if(databuf.recLen<6) { databuf.recLen+=6; break; } // add_r_show(PROTOCOL_CDT_FLAG,FRAME_START_CHAR,STRING_END_CHAR,packet_ptr,BB_PACKET_LENGTH); continue ; } if( m_recProcControl.m_flagControl ) //同步头校验正确与否 { if( PacketCheck( packet_ptr , 5 ) ) //控制字校验正确与否 { m_recProcControl.m_flagControl = FALSE; if( *packet_ptr == 0x71 ) { m_frameType = *(packet_ptr+1); // 帧类别 m_FrameCount= *(packet_ptr+2); // 信息字数 if(databuf.recLen<(m_FrameCount*6+6)) { databuf.recLen+=6; break; } if(pv[rtu_index].UseF == 1) { bRtuStatus = TRUE; if(is_parse) pv[rtu_index].State = 1; } else { bRtuStatus = FALSE; if(is_parse) pv[rtu_index].State = 0; } // TRACE("1%d\n",pv[rtu_index].State); // char funcRemark[18]; // memset(funcRemark,0x20,18); if( m_frameType== 0xf4 ) // 遥信状态帧（D1） { m_isYxFrame = TRUE; // sprintf(funcRemark,"**YX-D1帧**"); } else m_isYxFrame = FALSE; if (m_frameType == 0x61) // 0x61: A 帧 { m_nYcFrameType=0; } if (m_frameType == 0xc2) // 0xc2: B 帧 { m_nYcFrameType=1; } if(m_frameType == 0xb3) // 0xB3: C 帧 { m_nYcFrameType=2; } m_recProcControl.m_synControlTag |= BB_CON_TAG_BIT; m_recProcControl.m_continueErrNum = 0; add_r_show(PROTOCOL_CDT_FLAG,FRAME_START_CHAR,STRING_END_CHAR,packet_ptr-6,BB_PACKET_LENGTH); add_r_show(PROTOCOL_CDT_FLAG,CONTROL_START_CHAR,STRING_END_CHAR,packet_ptr,BB_PACKET_LENGTH); } else // if( *packet_ptr != 0x71 ) { m_recProcControl.m_synControlTag = 0; //控制字没有检测到 erorr_soft(); //RTU错误帧增加一次 } databuf.recLen -= BB_PACKET_LENGTH; } else // 控制字检测校验出错 { databuf.recLen--; m_count++; m_frameType=0; if( m_count >= BB_PACKET_LENGTH ) { m_count = 0; erorr_soft(); m_recProcControl.m_flagControl = FALSE; m_recProcControl.m_continueErrNum++; if( m_recProcControl.m_