From bd30f028a163c7293620064fc98744dacd41ceae Mon Sep 17 00:00:00 2001
From: LAPTOP-SNT8I5JK\Boounion <Chenluhua@qq.com>
Date: 星期三, 09 四月 2025 11:58:38 +0800
Subject: [PATCH] 1.CassetteControlCommand（cassette控制指令下发，测试页面）
---
SourceCode/Bond/Servo/CMaster.cpp | 24 ++++++++++++++++++++++++
1 files changed, 24 insertions(+), 0 deletions(-)
diff --git a/SourceCode/Bond/Servo/CMaster.cpp b/SourceCode/Bond/Servo/CMaster.cpp
index fff1ab0..6e00a3a 100644
--- a/SourceCode/Bond/Servo/CMaster.cpp
+++ b/SourceCode/Bond/Servo/CMaster.cpp
@@ -166,6 +166,17 @@
int CMaster::addLoadPort(int index)
{
ASSERT(index == 0 || index == 1 || index == 2 || index == 3);
+ static char* pszCassetteCtrlCmd[] = {
+ STEP_EQ_P1_CASSETTE_CTRL_CMD,
+ STEP_EQ_P2_CASSETTE_CTRL_CMD,
+ STEP_EQ_P3_CASSETTE_CTRL_CMD,
+ STEP_EQ_P4_CASSETTE_CTRL_CMD
+ };
+ int nWriteSignalDev[] = {0x120, 0x121, 0x122, 0x123};
+ int nCtrlCmdDev[] = {0x45, 0x1a5, 0x305, 0x465};
+ int nStepDev[] = { 0x480, 0x481, 0x482, 0x483 };
+
+
char szName[64];
sprintf_s(szName, 64, "LoadPort %d", index + 1);
CLoadPort* pEquipment = new CLoadPort();
@@ -174,6 +185,19 @@
pEquipment->setDescription(szName);
addToEquipmentList(pEquipment);
+
+ // step
+ {
+ CEqCassetteCtrlCmdStep* pStep = new CEqCassetteCtrlCmdStep();
+ pStep->setName(pszCassetteCtrlCmd[index]);
+ pStep->setWriteSignalDev(nWriteSignalDev[index]);
+ pStep->setCtrlCmdDev(nCtrlCmdDev[index]);
+ if (pEquipment->addStep(nStepDev[index], pStep) != 0) {
+ delete pStep;
+ }
+ }
+
+
pEquipment->init();
LOGE("已添加“%s”.", pEquipment->getName().c_str());
--
Gitblit v1.9.3