Ferdi's fixes

2012-11-29 11:42:44 +11:00
parent 33e0fada7c
commit 8e185c6291
1 changed files with 164 additions and 85 deletions
--- a/multicounter.c
+++ b/multicounter.c
@@ -77,9 +77,12 @@ static int MMCCHalt(void *pData)
 /*-------------------------------------------------------------------------*/
 static int MMCCStart(void *pData, SConnection * pCon)
 {
-  int i, status;
+  int i, status, controlMonitor;
+  int slavePreset, oneYear = 32000000;
  pCounter pCount = NULL;
  pMultiCounter self = NULL;
+  char buffer[128];
+  CounterMode slaveMode;

  pCount = (pCounter) pData;
  if (pCount != NULL) {
@@ -90,12 +93,25 @@ static int MMCCStart(void *pData, SConnection * pCon)
  if (!GetCountLock(pCount->pCountInt, pCon)) {
    return HWFault;
  }
+  controlMonitor = GetControlMonitor((pCounter) pCount);
+  if (pCount->pDriv->eMode == ePreset) {
+    slaveMode = eTimer;
+    slavePreset = oneYear;
+  } else {
+    slaveMode = pCount->pDriv->eMode;
+    slavePreset = pCount->pDriv->fPreset;
+  }

  for (i = 0; i < self->nSlaves; i++) {
    ReleaseCountLock(self->slaves[i]);
+    if (i == controlMonitor) {
      self->slaves[i]->SetCountParameters(self->slaveData[i],
                                          pCount->pDriv->fPreset,
                                          pCount->pDriv->eMode);
+    } else {
+      self->slaves[i]->SetCountParameters(self->slaveData[i],
+                                          slavePreset, slaveMode);
+    }
    status = self->slaves[i]->StartCount(self->slaveData[i], pCon);
    if (status != OKOK) {
      MMCCHalt(pData);
@@ -112,10 +128,18 @@ static int MMCCStart(void *pData, SConnection * pCon)
 /*-------------------------------------------------------------------------*/
 static int MMCCStatus(void *pData, SConnection * pCon)
 {
-  int status, i;
+  int status, ctrStatus, i, controlMonitor;
+  pCounter pCountController = NULL, pSlaveCounter = NULL;
  pCounter pCount = NULL, pMaster = NULL;;
  pMultiCounter self = NULL;
  pDummy pDum = NULL;
+  enum {
+    eIdle,
+    eBusy,
+    ePause,
+    eNoBeam,
+    eFault
+  } statusLevel;

  pCount = (pCounter) pData;
  if (pCount != NULL) {
@@ -132,6 +156,44 @@ static int MMCCStatus(void *pData, SConnection * pCon)
  status = self->slaves[0]->CheckCountStatus(self->slaveData[0], pCon);
  pMaster = (pCounter)self->slaveData[0];
  pCount->pDriv->fLastCurrent = GetControlValue(pMaster);
+  controlMonitor = GetControlMonitor((pCounter) pCount);
+  pCountController = (pCounter) self->slaveData[controlMonitor];
+
+  /* counter states = HWIdle, HWBusy, HWPause, HWNoBeam, HWFault */
+  status = HWIdle;
+  statusLevel = eIdle;
+  for (i = 0; i < self->nSlaves; i++) {
+    pSlaveCounter = (pCounter) self->slaveData[i];
+    ctrStatus = self->slaves[i]->CheckCountStatus(pSlaveCounter, pCon);
+    if (statusLevel >= eFault)
+      continue;
+    switch (ctrStatus) {
+    case HWFault:
+      statusLevel = eFault;
+      status = HWFault;
+      break;
+    case HWNoBeam:
+      if (statusLevel < eNoBeam)
+        statusLevel = eNoBeam;
+      status = HWNoBeam;
+      break;
+    case HWPause:
+      if (statusLevel < ePause)
+        statusLevel = ePause;
+      status = HWPause;
+      break;
+    default:
+      if (pCountController->pDriv->eMode == ePreset && i == controlMonitor
+          && ctrStatus == HWIdle) {
+        statusLevel = eBusy;    /* Allow transition to HWPause or higher */
+        status = HWIdle;
+      } else if (statusLevel < eBusy && ctrStatus != HWIdle) {
+        /* ffr: We expect !HWIdle means HWBusy, if not the existing code should handle the exception */
+        statusLevel = eBusy;
+        status = ctrStatus;
+      }
+    }
+  }
  if (status == HWIdle || status == HWFault) {
    /*
       stop counting on slaves when finished or when an error 
@@ -231,7 +293,8 @@ static void loadCountData(pCounter pCount, const char *data)

  pPtr = (char *) data;
  pPtr = getNextMMCCNumber(pPtr, pNumber);
-  pCount->pDriv->fTime = atof(pNumber);
+  // SICS-195 get time from controlling monitor
+  // pCount->pDriv->fTime = atof(pNumber);
  while (pPtr != NULL && i < MAXCOUNT) {
    pPtr = getNextMMCCNumber(pPtr, pNumber);
    pCount->pDriv->lCounts[i] = atoi(pNumber);
@@ -245,14 +308,19 @@ static int MMCCTransfer(void *pData, SConnection * pCon)
  int i, retVal = OKOK, status;
  char pBueffel[132];
  pCounter pCount = NULL;
+  pCounter pCountController = NULL, pCountSlave;
  pMultiCounter self = NULL;
  int tclStatus;
+  int controlMonitor;
+  double avCntRt;

  pCount = (pCounter) pData;
  if (pCount != NULL) {
    self = (pMultiCounter) pCount->pDriv->pData;
  }
  assert(self);
+  controlMonitor = GetControlMonitor(pCount);
+  pCountController = (pCounter) self->slaveData[controlMonitor];

  for (i = 0; i < self->nSlaves; i++) {
    status = self->slaves[i]->TransferData(self->slaveData[i], pCon);
@@ -261,8 +329,18 @@ static int MMCCTransfer(void *pData, SConnection * pCon)
      snprintf(pBueffel,sizeof(pBueffel)-1,
              "WARNING:  slave histogram %d failed to transfer data", i);
      SCWrite(pCon, pBueffel, eWarning);
+    } else if (pCountController->pDriv->eMode == ePreset) {
+      if (i != controlMonitor) {
+        pCountSlave = (pCounter) self->slaveData[i];
+        avCntRt =
+            pCountSlave->pDriv->lCounts[0] / pCountSlave->pDriv->fTime;
+        pCountSlave->pDriv->lCounts[0] =
+            avCntRt * pCountController->pDriv->fTime;
+        pCountSlave->pDriv->fTime = pCountController->pDriv->fTime;
      }
    }
+  }
+  pCount->pDriv->fTime = pCountController->pDriv->fTime;
  if (self->transferScript != NULL) {
    MacroPush(pCon);
    tclStatus = Tcl_Eval(InterpGetTcl(pServ->pSics), self->transferScript);
@@ -461,6 +539,30 @@ int MakeMultiCounter(SConnection * pCon, SicsInterp * pSics,
  pDriv->pData = self;
  pDriv->KillPrivate = KillMultiDriver;
  pDriv->iNoOfMonitors = MAXCOUNT;
+  /*
+     now loop through the remaining arguments, thereby entering them into
+     the slave list.
+   */
+  self->nSlaves = 0;
+  for (i = 2; i < argc; i++) {
+    pCom = FindCommand(pSics, argv[i]);
+    if (!pCom) {
+      snprintf(pBueffel,sizeof(pBueffel)-1, "ERROR: object %s not found in MakeMultiCounter",
+              argv[i]);
+      SCWrite(pCon, pBueffel, eError);
+      continue;
+    }
+    pCount = GetCountableInterface(pCom->pData);
+    if (!pCount) {
+      snprintf(pBueffel,sizeof(pBueffel)-1, "ERROR: object %s is NOT countable", argv[i]);
+      SCWrite(pCon, pBueffel, eError);
+      continue;
+    }
+    self->slaves[self->nSlaves] = pCount;
+    self->slaveData[self->nSlaves] = pCom->pData;
+    self->nSlaves++;
+  }
+  pDriv->iNoOfMonitors = self->nSlaves;
  pNew = CreateCounter(argv[1], pDriv);
  if (pNew == NULL) {
    SCWrite(pCon, "ERROR: out of memory in MakeMultiCounter", eError);
@@ -483,29 +585,6 @@ int MakeMultiCounter(SConnection * pCon, SicsInterp * pSics,
  pNew->pCountInt->TransferData = MMCCTransfer;
  pNew->pCountInt->SetCountParameters = MMCCParameter;

-  /*
-     now loop through the remaining arguments, thereby entering them into
-     the slave list.
-   */
-  for (i = 2; i < argc; i++) {
-    pCom = FindCommand(pSics, argv[i]);
-    if (!pCom) {
-      snprintf(pBueffel,sizeof(pBueffel)-1, "ERROR: object %s not found in MakeMultiCounter",
-              argv[i]);
-      SCWrite(pCon, pBueffel, eError);
-      continue;
-    }
-    pCount = GetCountableInterface(pCom->pData);
-    if (!pCount) {
-      snprintf(pBueffel,sizeof(pBueffel)-1, "ERROR: object %s is NOT countable", argv[i]);
-      SCWrite(pCon, pBueffel, eError);
-      continue;
-    }
-    self->slaves[self->nSlaves] = pCount;
-    self->slaveData[self->nSlaves] = pCom->pData;
-    self->nSlaves++;
-  }
-
  /*
     now install our action command and we are done
   */