LAPTOP-SNT8I5JK\Boounion
2025-04-09 bd30f028a163c7293620064fc98744dacd41ceae
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());