~chenluhua/Bond2.git

#include "stdafx.h"
#include "CEquipment.h"
#include "ToolUnits.h"
 
 
namespace SERVO {
 
    CEquipment::CEquipment() : m_nID(0), m_strName(""), m_strDescription(""), m_station(0, 255)
    {
        m_listener = { nullptr, nullptr };
        m_alive = {FALSE, 0, FALSE};
        m_bCimState = FALSE;
        m_bUpstreamInline = FALSE;
        m_bDownstreamInline = FALSE;
        m_bLocalAlarm = FALSE;
        m_bAutoRecipeChange = FALSE;
        m_bVCREnable[0] = FALSE;
        m_pCclink = nullptr;
        InitializeCriticalSection(&m_criticalSection);
    }
 
    CEquipment::~CEquipment()
    {
        for (auto item : m_mapStep) {
            delete item.second;
        }
        m_mapStep.clear();
 
        DeleteCriticalSection(&m_criticalSection);
    }
 
    void CEquipment::setListener(EquipmentListener listener)
    {
        m_listener.onAlive = listener.onAlive;
        m_listener.onCimStateChanged = listener.onCimStateChanged;
    }
 
    void CEquipment::setCcLink(CCCLinkIEControl* pCcLink)
    {
        m_pCclink = pCcLink;
    }
 
    void CEquipment::getProperties(std::vector<std::pair<std::string, std::string>>& container)
    {
        container.clear();
        // Ê¾Àý£º½«Ò»Ð©ÊôÐÔÌí¼Óµ½ÈÝÆ÷
        container.push_back(std::make_pair("DeviceName", "ServoMotor"));
        container.push_back(std::make_pair("SerialNumber", "123456789"));
        container.push_back(std::make_pair("Version", "1.0"));
    }
 
    CStep* CEquipment::getStep(unsigned int addr)
    {
        auto iter = m_mapStep.find(addr);
        if (iter == m_mapStep.end()) return nullptr;
        return iter->second;
    }
 
    int CEquipment::addStep(unsigned int addr, CStep* pStep)
    {
        auto iter = m_mapStep.find(addr);
        if (iter != m_mapStep.end()) return -1;
        pStep->setCcLink(m_pCclink);
        m_mapStep[addr] = pStep;
        return 0;
    }
 
    void CEquipment::init()
    {
        CStep* pStep = new CStep();
        if (addStep(0x360, pStep) == 0) {
            pStep->init();
        }
        else {
            delete pStep;
        }
    }
 
    void CEquipment::term()
    {
        for (auto item : m_mapStep) {
            item.second->term();
        }
    }
 
    void CEquipment::setID(int nID)
    {
        m_nID = nID;
    }
 
    int CEquipment::getID()
    {
        return m_nID;
    }
 
    void CEquipment::setName(const char* pszName)
    {
        m_strName = pszName;
    }
 
    std::string& CEquipment::getName()
    {
        return m_strName;
    }
 
    void CEquipment::setDescription(const char* pszDescription)
    {
        m_strDescription = pszDescription;
    }
 
    std::string& CEquipment::getDescription()
    {
        return m_strDescription;
    }
 
    void CEquipment::setStation(int network, int station)
    {
        m_station.nNetNo = network;
        m_station.nStNo = station;
    }
 
    const StationIdentifier& CEquipment::getStation()
    {
        return m_station;
    }
 
    void CEquipment::setReadBitBlock(unsigned int start, unsigned int end)
    {
        m_blockReadBit.type = (unsigned int)DeviceType::B;
        m_blockReadBit.start = start;
        m_blockReadBit.end = end;
        m_blockReadBit.size = (m_blockReadBit.end - m_blockReadBit.start + 1) / 8;
        ASSERT(m_blockReadBit.size < BLOCK_BUFFER_MAX);
    }
 
    MemoryBlock& CEquipment::getReadBitBlock()
    {
        return m_blockReadBit;
    }
 
    void CEquipment::setWriteBitBlock(unsigned int start, unsigned int end)
    {
        m_blockWriteBit.type = (unsigned int)DeviceType::LB;
        m_blockWriteBit.start = start;
        m_blockWriteBit.end = end;
        m_blockWriteBit.size = (m_blockWriteBit.end - m_blockWriteBit.start + 1) / 8;
    }
 
    MemoryBlock& CEquipment::getWriteBitBlock()
    {
        return m_blockWriteBit;
    }
 
    void CEquipment::onTimer(UINT nTimerid)
    {
        // Ã¿¸ôÒ»Ãë£¬¼ì²éÒ»ÏÂALIVE×´Ì¬
 
        static int tick = 0;
        tick++;
        if (tick % (4 * 1) == 0) {
            m_alive.count++;
            if (m_alive.alive && m_alive.count > ALIVE_TIMEOUT) {
                m_alive.alive = FALSE;
                if (m_listener.onAlive != nullptr) {
                    m_listener.onAlive(this, m_alive.alive);
                }
            }
        }
    }
 
    void CEquipment::serialize(CArchive& ar)
    {
 
    }
 
    void CEquipment::onReceiveLBData(const char* pszData, size_t size)
    {
        /*
        TRACE("%s onReceiveLBData: %d bytes\n", m_strName.c_str(), size);
        for (unsigned int i = 0; i < size; i++) {
            if (pszData[i] != 0)
                TRACE("%d[%x]\n", i, pszData[i]);
        }
        */
 
        // ÒÔÏÂ½âÊÍºÍ´¦ÀíÊý¾Ý
        BOOL bFlag;
        int index = 0x340;
 
 
        // alive
        bFlag = isBitOn(pszData, size, index);
        if (!equalBool(m_alive.flag, bFlag)) {
            m_alive.flag = bFlag;
            m_alive.count = 0;
 
            // ×´Ì¬
            if (!m_alive.alive) {
                m_alive.alive = TRUE;
                if (m_listener.onAlive != nullptr) {
                    m_listener.onAlive(this, m_alive.alive);
                }
            }
        }
    
        // CIM State
        bFlag = isBitOn(pszData, size, ++index);
        if (!equalBool(m_bCimState, bFlag)) {
            m_bCimState = bFlag;
            if (m_listener.onCimStateChanged != nullptr) {
                m_listener.onCimStateChanged(this, m_bCimState);
            }
        }
 
        // UpstreamInline
        bFlag = isBitOn(pszData, size, ++index);
        if (!equalBool(m_bUpstreamInline, bFlag)) {
            m_bUpstreamInline = bFlag;
        }
 
        // DownstreamInline
        bFlag = isBitOn(pszData, size, ++index);
        if (!equalBool(m_bDownstreamInline, bFlag)) {
            m_bDownstreamInline = bFlag;
        }
 
        // LocalAlarm
        bFlag = isBitOn(pszData, size, ++index);
        if (!equalBool(m_bLocalAlarm, bFlag)) {
            m_bLocalAlarm = bFlag;
        }
 
        // AutoRecipeChange
        bFlag = isBitOn(pszData, size, ++index);
        if (!equalBool(m_bAutoRecipeChange, bFlag)) {
            m_bAutoRecipeChange = bFlag;
        }
 
        // AutoRecipeChange
        bFlag = isBitOn(pszData, size, ++index);
        if (!equalBool(m_bVCREnable[0], bFlag)) {
            m_bVCREnable[0] = bFlag;
        }
 
 
        // ÒÔÏÂ¸ù¾ÝÐÅºÅ×öÁ÷³Ì´¦Àí
 
        // Equipment Mode Change Report
        index = 0x360;
        bFlag = isBitOn(pszData, size, index);
        CStep* pStep = getStep(0x360);
        if (pStep != nullptr) {
            pStep->onSignal(bFlag);
        }
    }
 
    BOOL CEquipment::isBitOn(const char* pszData, size_t size, int index)
    {
        int byteIndex, bitIndex;
        byteIndex = (index) / 8;
        bitIndex = (index) % 8;
 
        return CToolUnits::getBit(pszData[byteIndex], bitIndex);
    }
 
    BOOL CEquipment::equalBool(BOOL b1, BOOL b2)
    {
        return (b1 && b2) || (!b1 && !b2);
    }
 
    BOOL CEquipment::isAlive()
    {
        return m_alive.alive;
    }
 
    BOOL CEquipment::isCimOn()
    {
        return m_bCimState;
    }
 
    BOOL CEquipment::isUpstreamInline()
    {
        return m_bUpstreamInline;
    }
 
    BOOL CEquipment::isDownstreamInline()
    {
        return m_bDownstreamInline;
    }
 
    BOOL CEquipment::isLocalAlarm()
    {
        return m_bLocalAlarm;
    }
 
    BOOL CEquipment::isAutoRecipeChange()
    {
        return m_bAutoRecipeChange;
    }
 
    BOOL CEquipment::isVCREnable(unsigned int index)
    {
        if (index >= VCR_MAX) return FALSE;
        return m_bVCREnable[index];
    }
}