#include "stdafx.h"
|
#include "Common.h"
|
#include "CMaster.h"
|
|
namespace SERVO {
|
CMaster* g_pMaster = NULL;
|
void CALLBACK MasterTimerProc(HWND hWnd, UINT nMsg, UINT nTimerid, DWORD dwTime)
|
{
|
if (g_pMaster != NULL) {
|
g_pMaster->onTimer(nTimerid);
|
}
|
}
|
|
CMaster::CMaster()
|
{
|
m_listener = {nullptr, nullptr, nullptr};
|
}
|
|
CMaster::~CMaster()
|
{
|
for (auto item : m_listEquipment) {
|
delete item;
|
}
|
m_listEquipment.clear();
|
}
|
|
void CMaster::setListener(MasterListener listener)
|
{
|
m_listener.onEqAlive = listener.onEqAlive;
|
m_listener.onEqCimStateChanged = listener.onEqCimStateChanged;
|
m_listener.onEqStepEvent = listener.onEqStepEvent;
|
}
|
|
int CMaster::init()
|
{
|
LOGI("<Master>ÕýÔÚ³õʼ»¯...");
|
|
|
StepListener listener;
|
listener.onEvent = [&](void* pStep, int code, void* pData) -> void {
|
TRACE("<CEquipment>onEvent<%d, 0x%x>.\n", code, pData);
|
if (m_listener.onEqStepEvent != nullptr) {
|
m_listener.onEqStepEvent((CStep*)pStep, code, pData);
|
}
|
};
|
|
|
// cclink
|
if (m_cclink.Connect(CC_LINK_IE_CONTROL_CHANNEL(1)) != 0) {
|
LOGE("Á¬½ÓCC-Linkʧ°Ü.");
|
}
|
else {
|
LOGI("Á¬½ÓCC-Link³É¹¦.");
|
BoardVersion version{};
|
int nRet = m_cclink.GetBoardVersion(version);
|
if (nRet == 0) {
|
LOGI("°æ±¾ÐÅÏ¢£º%s.", version.toString().c_str());
|
}
|
else {
|
LOGE("»ñÈ¡CC-Link°æ±¾ÐÅϢʧ°Ü.");
|
}
|
|
BoardStatus status;
|
nRet = m_cclink.GetBoardStatus(status);
|
if (nRet == 0) {
|
LOGI("״̬£º%s.", status.toString().c_str());
|
}
|
else {
|
LOGE("»ñÈ¡CC-Link״̬ʧ°Ü.");
|
}
|
}
|
|
|
// ³õʼ»¯Ìí¼Ó¸÷×ÓÉ豸
|
addEFEM(listener);
|
|
/*
|
{
|
CBonder* pBonder = new CBonder();
|
pBonder->setName("Bonder 1");
|
pBonder->setDescription("Bonder 1.");
|
pBonder->setReadBitBlock(0x4600, 0x4bff);
|
pBonder->setStation(1, 3);
|
addEquipment(pBonder);
|
LOGE("ÒÑÌí¼Ó¡°Bonder 1¡±.");
|
}
|
*/
|
|
// ¶¨Ê±Æ÷
|
g_pMaster = this;
|
SetTimer(NULL, 1, 250, (TIMERPROC)MasterTimerProc);
|
|
|
LOGI("<Master>³õʼ»¯Íê³É.");
|
return 0;
|
}
|
|
int CMaster::term()
|
{
|
LOGI("<Master>ÕýÔÚ½áÊø³ÌÐò.");
|
for (auto item : m_listEquipment) {
|
item->term();
|
}
|
|
return 0;
|
}
|
|
int CMaster::addEquipment(CEquipment* pEquipment)
|
{
|
EquipmentListener listener;
|
listener.onAlive = [&](void* pEquipment, BOOL bAlive) -> void {
|
CEquipment* p = (CEquipment*)pEquipment;
|
if (m_listener.onEqAlive != nullptr) {
|
m_listener.onEqAlive(this, p, bAlive);
|
}
|
};
|
listener.onCimStateChanged = [&](void* pEquipment, BOOL bOn) -> void {
|
CEquipment* p = (CEquipment*)pEquipment;
|
if (m_listener.onEqCimStateChanged != nullptr) {
|
m_listener.onEqCimStateChanged(this, p, bOn);
|
}
|
};
|
pEquipment->setListener(listener);
|
pEquipment->setCcLink(&m_cclink);
|
m_listEquipment.push_back(pEquipment);
|
|
return 0;
|
}
|
|
std::list<CEquipment*>& CMaster::getEquipmentList()
|
{
|
return m_listEquipment;
|
}
|
|
CEquipment* CMaster::getEquipment(int id)
|
{
|
for (auto item : m_listEquipment) {
|
if (item->getID() == id) return item;
|
}
|
|
return nullptr;
|
}
|
|
int CMaster::addEFEM(StepListener& listener)
|
{
|
CEFEM* pEquipment = new CEFEM();
|
pEquipment->setID(EQ_ID_EFEM);
|
pEquipment->setBaseAlarmId(BASE_ALARM_EFEM);
|
pEquipment->setName("EFEM(ROBOT)");
|
pEquipment->setDescription("EFEM(ROBOT).");
|
pEquipment->setReadBitBlock(0x4000, 0x45ff);
|
pEquipment->setStation(0, 255);
|
addEquipment(pEquipment);
|
|
|
// Ìí¼Ó step
|
{
|
CEqModeStep* pStep = new CEqModeStep();
|
pStep->setName(STEP_MODE);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x30);
|
pStep->setModeDev(0x4a8c);
|
if (pEquipment->addStep(0x360, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqStatusStep* pStep = new CEqStatusStep();
|
pStep->setName(STEP_STATUS);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x31);
|
pStep->setStatusDev(0x4a68);
|
if (pEquipment->addStep(0x361, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqAlarmStep* pStep = new CEqAlarmStep();
|
pStep->setName(STEP_ALARM_BLOCK1);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x32);
|
pStep->setAlarmDev(0x4c1d);
|
if (pEquipment->addStep(0x362, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqAlarmStep* pStep = new CEqAlarmStep();
|
pStep->setName(STEP_ALARM_BLOCK2);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x33);
|
pStep->setAlarmDev(0x4c4a);
|
if (pEquipment->addStep(0x363, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqAlarmStep* pStep = new CEqAlarmStep();
|
pStep->setName(STEP_ALARM_BLOCK3);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x34);
|
pStep->setAlarmDev(0x4c77);
|
if (pEquipment->addStep(0x364, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqAlarmStep* pStep = new CEqAlarmStep();
|
pStep->setName(STEP_ALARM_BLOCK4);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x35);
|
pStep->setAlarmDev(0x4ca4);
|
if (pEquipment->addStep(0x365, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqAlarmStep* pStep = new CEqAlarmStep();
|
pStep->setName(STEP_ALARM_BLOCK5);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x36);
|
pStep->setAlarmDev(0x4cd1);
|
if (pEquipment->addStep(0x366, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqProcessStep* pStep = new CEqProcessStep();
|
pStep->setName(STEP_PROCESS);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x37);
|
pStep->setProcessDev(0x1864);
|
if (pEquipment->addStep(0x367, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqCimModeChangeStep* pStep = new CEqCimModeChangeStep();
|
pStep->setName(STEP_CIM_MODE_CHANGE);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x50);
|
pStep->setCimModeDev(0x15);
|
if (pEquipment->addStep(0x350, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqModeChangeStep* pStep = new CEqModeChangeStep();
|
pStep->setName(STEP_EQ_MODE_CHANGE);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x51);
|
pStep->setEqModeDev(0x1E);
|
if (pEquipment->addStep(0x351, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqCimMessageCmdStep* pStep = new CEqCimMessageCmdStep();
|
pStep->setName(STEP_CIM_MESSAGE_CMD);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x53);
|
pStep->setCimMessageDev(0x0);
|
if (pEquipment->addStep(0x352, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
{
|
CEqCimMessageClearStep* pStep = new CEqCimMessageClearStep();
|
pStep->setName(STEP_CIM_MESSAGE_CLEAR);
|
pStep->setListener(listener);
|
pStep->setWriteSignalDev(0x54);
|
pStep->setClearCimMessageDev(0x13);
|
if (pEquipment->addStep(0x353, pStep) != 0) {
|
delete pStep;
|
}
|
}
|
|
pEquipment->init();
|
LOGE("ÒÑÌí¼Ó¡°EFEM(ROBOT)¡±.");
|
return 0;
|
}
|
|
void CMaster::onTimer(UINT nTimerid)
|
{
|
for (auto item : m_listEquipment) {
|
item->onTimer(nTimerid);
|
}
|
|
|
// °´Ò»¶¨ÆµÂÊɨÃèLBÊý¾Ý
|
static int i = 0;
|
i++;
|
if (i % (4 * 1) == 0) {
|
|
for (auto item : m_listEquipment) {
|
const StationIdentifier& station = item->getStation();
|
MemoryBlock& block = item->getReadBitBlock();
|
|
int nRet = m_cclink.ReadData2(station, (DeviceType)block.type,
|
block.start, block.size, block.buffer);
|
if (0 == nRet) {
|
item->onReceiveLBData(block.buffer, block.size);
|
}
|
}
|
}
|
}
|
}
|
