ISCS需求及问题

#if defined(WIN32)

#include    <io.h>

#include "stdafx.h"

#endif

#include    <limits.h>

#include    <sys/stat.h>

#include	<sys/timeb.h>

#include	<time.h>

#include "mBim4.h"

#include "se_log.h"

#include "daq/daq_utl.h"

extern CRdbTable DEF_DCDLL  RDB_Chan;

unsigned int CRC_16(unsigned char * pSendBuf, unsigned char len)//CRC??????

{ 

    unsigned short wCrc = 0xFFFF;

    for(int i=0; i<len;i++)

    {

        wCrc ^= pSendBuf[i];

        for(int j=0; j<8; j++)

        {

            if(wCrc & 1)

            {

                wCrc >>= 1; 

                wCrc ^= 0xA001; 

            }

            else

                wCrc >>= 1; 

        }

    }

    return wCrc;

}

CMBim::CMBim()

{

#ifdef OS_WIN

    m_logger = new Logger("BimS", "mBimS.log");

    m_logger->WriteLineSeparator("Create a new class instance. ", 2);

#endif

    readIni();

}

CMBim::~CMBim()

{

    if (m_iniConfig.rtuConfArray != NULL)

    {

        delete [] m_iniConfig.rtuConfArray;

    }

#ifdef OS_WIN

    delete m_logger;

#endif

}

void CMBim::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;

	sint32 buflen = pRxBuf->GetReadableSize();   

	pRxBuf->Move(buflen);

	buflen = pTxBuf->GetReadableSize();

	pTxBuf->Move(buflen);

	m_sendData.headP = m_sendData.trailP=m_sendData.databuf;

    initStation();

}

void CMBim::initStation()

{

    m_flagSendType = 3;

    m_nSendFrameNo = 0;

    m_nSendSeqNo = 0;

    pLink->SetCommStatus(CMST_NORMAL);

}

void CMBim::readIni()

{

    memset(&m_iniConfig, 0, sizeof(BimIniConfig));

    char *home = getenv("SEROOT");

    if (NULL == home)

    {

        PrintLog(LOG_ERROR, "????????SEROOTδ????");

        return;

    }

    char filename[256] = {0};

#if defined(__unix)

    sprintf(filename, "%s%s", home, "/cfg/p104exs.ini");

#else

    sprintf(filename, "%s%s", home, "\\cfg\\p104exs.ini");

#endif

    CReadConf readconf;

    int nValue = readconf.ReadLong("PORT1", "RTUCOUNT", filename, "0");

    if (nValue <= 0)

    {

        PrintLog(LOG_ERROR, "RTU??????????");

        return;

    }

    m_iniConfig.totalRtus = nValue;

    //     nValue = readconf.ReadLong("PORT1", "PORTNO", filename, "0");

    //     if (nValue <= 0) {

    //         PrintLog(LOG_ERROR, "?˿ں???????", sSection);

    //         return;

    //     }

    //     else

    //         m_iniConfig.portNo = nValue;

    uint32 i;

    char sSection[6] = {0};

    uint32 nRtuCount = m_iniConfig.totalRtus;

    m_iniConfig.rtuConfArray = new BimRTUConfig[nRtuCount];

    for (i=0; i<nRtuCount; i++)

    {

        memset(sSection, 0, sizeof(char)*6);

        sprintf(sSection, "RTU%d", i+1);

        LPBimRTUConfig pRTU = m_iniConfig.rtuConfArray + i;

        pRTU->rtuNo = readconf.ReadLong(sSection, "rtuNo", filename, "0");

        pRTU->totalYX = readconf.ReadLong(sSection, "yx", filename, "0");

        pRTU->totalYC = readconf.ReadLong(sSection, "yc", filename, "0");

        pRTU->totalYxBlock = (pRTU->totalYX + DINumberPerBlock - 1) / DINumberPerBlock;

        pRTU->totalYcFrame = (pRTU->totalYC + MaxObjPerFrame_DIAI/2 - 1) / (MaxObjPerFrame_DIAI/2);

    }    

}

// 

sint32	CMBim::RxProc()

{

#if 1

    if ( (m_flagSendType & 0x3) == 0)

        m_flagSendType = 0x3;

    sint32 count = RDB_Chan.GetRcdCount();

    if( count>DEF_DCV_MAX_CHANNUM ) 

        count = DEF_DCV_MAX_CHANNUM;

	S_RDB_Chan * pChan = (S_RDB_Chan * )RDB_Chan.GetRcdAddr(0);

    sint32 chanNo = pLink->GetChanNo();

    for (int i=0; i<count; i++)

    {

        if (pChan[i].ChanNo == chanNo)

        {

            pChan[i].State = EDEV_UP_STATE;

            break;

        }

    }

    pLink->RegisterFrm( FRAME_RX_SUC );

//     pLink->SetCommStatus(CMST_NORMAL);

    return 1;

#else

    uint8 buf[256];

    sint32 buflen = pRxBuf->GetReadableSize();

    if (buflen < RxDataLen)

        return 1;

    pLink->RegisterFrm( FRAME_RX_SUC );

    pLink->SetCommStatus(CMST_NORMAL);

    sint32 datalen = 0;

    while ( (buflen=pRxBuf->GetReadableSize()) >= RxDataLen)

    {

        if (buflen > 256)

            buflen = 256;

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

        if (buf[0] != 0xEB || buf[1] != 0x90)

        {

            sint32 unuse = 0;

            while (unuse < datalen)

            {

                if (buf[unuse] != 0xEB || buf[unuse+1] != 0x90)

                    unuse++;

                else

                    break;

            }

            pRxBuf->Move(unuse);

            continue;

        }

        if (buf[2] != FixSysID_Req)

        {

            pRxBuf->Move(3);

            continue;

        }

        if (buf[5] != 5 || buf[6] != 0)//?̶?????Ϊ5

        {

            pRxBuf->Move(3);

            continue;

        }

        if (buf[8] != ReqTypeID_DI && buf[8] != ReqTypeID_AI)

        {

            pRxBuf->Move(7);

            continue;

        }

        unsigned int crcValue = CRC_16(buf, RxDataLen-2);

        if (buf[RxDataLen-2] != (crcValue%0x100) || buf[RxDataLen-1] != (crcValue/0x100))

        {

            pRxBuf->Move(RxDataLen);

            PrintLog(LOG_ERROR, "У???????");

            return 0;

        }

        if (buf[8] == ReqTypeID_DI)//DI

        {

            setFlagToDI(buf, datalen);

        }

        else if (buf[8] == ReqTypeID_AI)//AI

        {

            setFlagToAI(buf, datalen);

        }

	}

	return 1;

#endif

}

// 

sint32 CMBim::TxProc()

{

	uint16 wLen=pTxBuf->GetWritableSize();

	int len = m_sendData.trailP - m_sendData.headP;

	if(wLen<=len)

		return 0;

    if ( (m_flagSendType & 0x1) == 0x1)

    {

        if (procSendDI() == 1)

            return 1;

    }

    if ( (m_flagSendType & 0x2) == 0x2)

    {

        if (procSendAI() == 1)

            return 1;

    }

	return 1;

}

// sint32 CMBim::GetNowSecond()

// {

//     CSeTime     SE_T;

//     TCriterionTime tmptime;

//     SE_T.GetNow(&tmptime);

//     return (sint32)tmptime;

// }

void CMBim::setFlagToDI(uint8 *buf, sint32 buflen)

{

    PrintLog(LOG_INFORMATION, "?յ?????DI֡");

    m_flagSendType |= 0x1;

    pLink->RegisterFrmCode(RAW_CODEDIR_UP, (char *)buf, RxDataLen);

    pRxBuf->Move(RxDataLen);

}

void CMBim::setFlagToAI(uint8 *buf, sint32 buflen)

{

    PrintLog(LOG_INFORMATION, "?յ?????AI֡");

    m_flagSendType |= 0x2;

    pLink->RegisterFrmCode(RAW_CODEDIR_UP, (char *)buf, RxDataLen);

    pRxBuf->Move(RxDataLen);

}

void CMBim::appToLink()

{

    BYTE * p = m_sendData.databuf;

    int len = m_sendData.trailP - m_sendData.headP;

    unsigned int crcValue = CRC_16(p, len);

    *m_sendData.trailP++ = crcValue % 0x100;

    *m_sendData.trailP++ = crcValue / 0x100;

    len = m_sendData.trailP - m_sendData.headP;

/*       

#ifdef OS_WIN

    if (m_logger->IfLogData()) {

        TCHAR strLog[MaxCodeLen] = {0};

        _stprintf(strLog, _T("???ͱ???(?ֽ??? %d) :\n"), len);

        sint32 i;

        for (i=0; i<len; i++)

        {

            TCHAR tmpStr[5] = {0};

            if ( (i+1)/32 > 0 && (i+1)%32 == 0)

                _stprintf(tmpStr, _T("%02X  \n"), *(p+i));

            else

                _stprintf(tmpStr, _T("%02X  "), *(p+i));

            if ( _tcslen(strLog) + _tcslen(tmpStr) > MaxCodeLen-1) {

                m_logger->WriteFmtStrWithTime_L3(strLog);

                memset(strLog, 0, sizeof(TCHAR)*MaxCodeLen);

            }

            _tcscat(strLog, tmpStr);

        }

        m_logger->WriteFmtStrWithTime_L3(strLog);

    }

#endif*/

	int txMaxLen=TxDataMaxLen;

	if(16*1024<TxDataMaxLen)txMaxLen=16*1024;

//     pLink->RegisterFrmCode(RAW_CODEDIR_DOWN, (char *)p, len);

	uint16 wLen=pTxBuf->GetWritableSize();//WYF 20190526

	if(wLen>=len){

//		if(len>txMaxLen-1100)

		{

			pTxBuf->Write(p, len);

			m_sendData.headP = m_sendData.trailP=m_sendData.databuf;

		}

	}

	else{

//		m_sendData.headP = m_sendData.trailP=m_sendData.databuf;

		PrintLog(LOG_ERROR, "TxBuffʣ??%d??ʵ???跢??%d",wLen,len);

		return;

	}

//     pLink->SetCommStatus(CMST_NORMAL);

    pLink->RegisterFrm( FRAME_TX_SUC );

    return;

}

// index base 0

sint32 CMBim::procSendDI()

{

    if (NULL == m_iniConfig.rtuConfArray)

    {

        PrintLog(LOG_ERROR, "RTUδ????");

        m_flagSendType &= 0xFE;

        m_nSendFrameNo = 0;

        return 0;

    }

    // get start RTU

    uint32 nRtuNo = 0;    

    uint32 nCalcFrames = 0; // total frames have been sent (not include current RTU)

    uint32 nTotalFramesRTU = 0; // total frames of current RTU

    uint32 nInfoAddrStart = 0; // start address of current frame (:= 0~0xFFFFFF)

    LPBimRTUConfig pRtu = NULL;

	bool bFinishedCycle =false;

while ( nRtuNo < m_iniConfig.totalRtus)

{

        pRtu = m_iniConfig.rtuConfArray + nRtuNo;

        nTotalFramesRTU = (pRtu->totalYxBlock + MaxObjPerFrame_DIAI - 1) / MaxObjPerFrame_DIAI;

        if (m_nSendFrameNo < nCalcFrames + nTotalFramesRTU)//SendFrameNo : index base from 0

            break;

        nCalcFrames += nTotalFramesRTU;

        nInfoAddrStart += (pRtu->totalYxBlock * 2);

        nRtuNo++;

}

    if (nRtuNo >= m_iniConfig.totalRtus || NULL == pRtu)

    {

        PrintLog(LOG_ERROR, "RTU?????????????????????ļ?????ǰRTU %d", nRtuNo+1);

        m_flagSendType &= 0xFE;

        m_nSendFrameNo = 0;

        return 0;

    }

    uint32 nRtuFrameNo = m_nSendFrameNo - nCalcFrames; // frame number of current RTU

    nInfoAddrStart += (MaxObjPerFrame_DIAI * nRtuFrameNo*2);//wyf 2018

    uint32 nRtuPointStart = (MaxObjPerFrame_DIAI * DINumberPerBlock) * nRtuFrameNo; // get from which DI start

#ifdef OS_WIN

    if (m_nSendFrameNo == 0) {

        m_SendData_TimeBegin = m_SendTypeData_TimeBegin = GetTickCount();

//         m_logger->WriteFmtStrWithTime_L2("Begin to send DI, time : %ums", m_SendTypeData_TimeBegin);

    }

#endif

    // re-calculate max DI

    uint32 nRetPoint = pRtu->totalYX - nRtuPointStart;

    uint32 nMaxPoint = (MaxObjPerFrame_DIAI * DINumberPerBlock); // max DI of current frame

    nMaxPoint = nRetPoint < nMaxPoint ? nRetPoint : nMaxPoint;

    // save DI into buffer

    uint8 buf[1024] = {0};

    uint32 byteIndex, bitIndex;

    uint32 i;

    for (i=0; i<nMaxPoint; i++)

    {

        byteIndex = i/DINumberPerBlock * 2 + i%DINumberPerBlock / 8;

        bitIndex = i % 8;

        uint8 btVal = 0;

        PRawCtrl->GetAYx(pRtu->rtuNo, nRtuPointStart+i, &btVal);

        if (btVal == 1)

            buf[byteIndex] |= (1 << bitIndex);

    }

    // DATA_HEAD

    DATA_HEAD dataHead;

    dataHead.HeadLo = 0xEB;

    dataHead.HeadHi = 0x90;

    dataHead.SysID = FixSysID_Ans;

    dataHead.PacketNoLo = m_nSendSeqNo % 256;

    dataHead.PacketNoHi = m_nSendSeqNo / 256;

    uint16 nBlock = (nMaxPoint+DINumberPerBlock-1) / DINumberPerBlock;

    uint16 framelen = nBlock * 2 + 8;

    dataHead.LenLo = framelen % 256;

    dataHead.LenHi = framelen / 256;

    bFinishedCycle = false;

    if ( (nRtuNo >= m_iniConfig.totalRtus-1) && (nRtuFrameNo >= nTotalFramesRTU-1) )

        bFinishedCycle = true;

    if (bFinishedCycle)

        dataHead.MultiFlag = 0;

    else

        dataHead.MultiFlag = 1;

    dataHead.MsgID = ReqTypeID_DI;

    //

    uint8 *ptr = m_sendData.trailP;//m_sendData.databuf+;

//    m_sendData.headP = m_sendData.trailP = ptr;

    memcpy(ptr, (BYTE *)&dataHead, DataHeadLen);

    ptr += DataHeadLen;

//     uint32 nMaxCount = nBlock * DINumberPerBlock;

    uint32 nMaxCount = nMaxPoint;

    *ptr++ = nMaxCount & 0xFF;

    *ptr++ = (nMaxCount >> 8) & 0xFF;

    *ptr++ = (nMaxCount >> 16) & 0xFF;

    *ptr++ = nInfoAddrStart & 0xFF;

    *ptr++ = (nInfoAddrStart >> 8) & 0xFF;

    *ptr++ = (nInfoAddrStart >> 16) & 0xFF;

    memcpy(ptr, (BYTE *)buf, nBlock*2);

    ptr += nBlock * 2;

    m_sendData.trailP = ptr;

    PrintLog(LOG_INFORMATION, "????DI??Ӧ֡");

    appToLink();

    m_nSendSeqNo = (m_nSendSeqNo + 1) % 0xFFFF;

    if (bFinishedCycle)

    {

        m_flagSendType &= 0xFE;

        m_nSendFrameNo = 0;

#ifdef OS_WIN

        DWORD curTick = GetTickCount();

        m_logger->WriteFmtStrWithTime_L2(_T("ң?? ??????ϣ???ʱ: %us(%ums)"), (curTick-m_SendTypeData_TimeBegin)/1000, curTick-m_SendTypeData_TimeBegin);

        m_SendTypeData_TimeBegin = 0;

#endif

    }

    else

        m_nSendFrameNo++;

    return 1;

}

sint32 CMBim::procSendAI()

{

    if (NULL == m_iniConfig.rtuConfArray)

    {

        PrintLog(LOG_ERROR, "RTUδ????");

        m_flagSendType &= 0xFD;

        m_nSendFrameNo = 0;

        return 0;

    }

    // get start RTU

    uint32 nRtuNo = 0;    

    uint32 nCalcFrames = 0; // total frames have been sent (not include current RTU)

    uint32 nTotalFramesRTU = 0; // total frames of current RTU

    uint32 nInfoAddrStart = 0; // start address of current frame (:= 0~0xFFFFFF)

    LPBimRTUConfig pRtu = NULL;

	bool bFinishedCycle =false;

 while (nRtuNo < m_iniConfig.totalRtus)

 {

        pRtu = m_iniConfig.rtuConfArray + nRtuNo;

        nTotalFramesRTU = pRtu->totalYcFrame;

        if (m_nSendFrameNo < nCalcFrames + nTotalFramesRTU)//SendFrameNo : index base from 0

            break;

        nCalcFrames += nTotalFramesRTU;

        nInfoAddrStart += pRtu->totalYC;

        nRtuNo++;

}

    if (nRtuNo >= m_iniConfig.totalRtus || NULL == pRtu)

    {

        PrintLog(LOG_ERROR, "AI?㳬?????????????ļ?????ǰRTU %d", nRtuNo+1);

        m_flagSendType &= 0xFD;

        m_nSendFrameNo = 0;

        return 0;

    }    

    uint32 nRtuFrameNo = m_nSendFrameNo - nCalcFrames; // frame number of current RTU

    nInfoAddrStart += MaxObjPerFrame_DIAI/2 * nRtuFrameNo;

    uint32 nMaxPoint = MaxObjPerFrame_DIAI/2; // max DI of current frame

    uint32 nRtuPointStart = nMaxPoint * nRtuFrameNo; // get from which DI start

#ifdef OS_WIN

    if (m_nSendFrameNo == 0) {

        m_SendTypeData_TimeBegin = GetTickCount();

//         m_logger->WriteFmtStrWithTime_L2("Begin to send AI, time : %ums", m_SendTypeData_TimeBegin);

    }

#endif

    // re-calculate max DI

    uint32 nRetPoint = pRtu->totalYC - nRtuPointStart;

    nMaxPoint = nRetPoint < nMaxPoint ? nRetPoint : nMaxPoint;

    // save DI into buffer

    uint8 buf[1024] = {0};

    uint32 byteIndex;

    uint32 i;

	if(pRtu->rtuNo==18 && nRtuPointStart<2)//test

		nRtuPointStart=nRtuPointStart;//test

    for (i=0; i<nMaxPoint; i++)

    {

        byteIndex = i*2*2;

        float32 fVal = 0.0f;

        PRawCtrl->GetAYc(pRtu->rtuNo, nRtuPointStart+i, &fVal);

		uint8 *tmp=(uint8 *)&fVal;

        buf[byteIndex] = *tmp; 

        buf[byteIndex+1] = *(tmp+1); 

        buf[byteIndex+2] = *(tmp+2); 

        buf[byteIndex+3] = *(tmp+3); 

    }

    // DATA_HEAD

    DATA_HEAD dataHead;

    dataHead.HeadLo = 0xEB;

    dataHead.HeadHi = 0x90;

    dataHead.SysID = FixSysID_Ans;

    dataHead.PacketNoLo = m_nSendSeqNo % 256;

    dataHead.PacketNoHi = m_nSendSeqNo / 256;

    uint16 framelen = nMaxPoint * 2*2 + 8;

    dataHead.LenLo = framelen % 256;

    dataHead.LenHi = framelen / 256;

    bFinishedCycle = false;

    if ( (nRtuNo >= m_iniConfig.totalRtus-1) && (nRtuFrameNo >= nTotalFramesRTU-1) )

        bFinishedCycle = true;

    if (bFinishedCycle)

        dataHead.MultiFlag = 0;

    else

        dataHead.MultiFlag = 1;

    dataHead.MsgID = ReqTypeID_AI;

    //

    uint8 *ptr = m_sendData.trailP;//m_sendData.databuf;

//    m_sendData.headP = m_sendData.trailP = ptr;

    memcpy(ptr, (BYTE *)&dataHead, DataHeadLen);

    ptr += DataHeadLen;

    *ptr++ = nMaxPoint & 0xFF;

    *ptr++ = (nMaxPoint >> 8) & 0xFF;

    *ptr++ = (nMaxPoint >> 16) & 0xFF;

    *ptr++ = nInfoAddrStart & 0xFF;

    *ptr++ = (nInfoAddrStart >> 8) & 0xFF;

    *ptr++ = (nInfoAddrStart >> 16) & 0xFF;

    memcpy(ptr, (BYTE *)buf, nMaxPoint*2*2);

    ptr += nMaxPoint * 2*2;

    m_sendData.trailP = ptr;

    PrintLog(LOG_INFORMATION, "????AI??Ӧ֡");

    appToLink();

    m_nSendSeqNo = (m_nSendSeqNo + 1) % 0xFFFF;

    if (bFinishedCycle)

    {

        m_flagSendType &= 0xFD;

        m_nSendFrameNo = 0;

#ifdef OS_WIN

        DWORD curTick = GetTickCount();

        m_logger->WriteFmtStrWithTime_L2(_T("ң?? ??????ϣ???ʱ: %us(%ums)"), (curTick-m_SendTypeData_TimeBegin)/1000, curTick-m_SendTypeData_TimeBegin);

        m_logger->WriteFmtStrWithTime_L2(_T("???? ???? ??????ϣ???ʱ: %us(%ums)"), (curTick-m_SendData_TimeBegin)/1000, curTick-m_SendData_TimeBegin);

        if (curTick-m_SendData_TimeBegin > 2000)

            m_logger->WriteFmtStrWithTime_L2(_T("\n???η??????? ??ʱ????2s\n"));

        m_SendData_TimeBegin = m_SendTypeData_TimeBegin = 0;

#endif

    }

    else

        m_nSendFrameNo++;

    return 1;

}

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

#if defined(WIN32)

		extern "C" __declspec(dllexport) 

#else 

	extern "C"

#endif

CProtocol	*CreateProtocol(char *defpara)

{

	return (CProtocol*)(new CMBim());

}