#include "ipc_basis.h"
 #include "hwship.h"
 
+/* set this to 8 for zero supp on, 0 for off */
+#define ZEROSUP 8
+
 static int bankRequested(HwShip *my) {
        UInt2 val;
 
 }
 
 static void acquireMode(HwShip *my) {
-       LVme_setW(my->lvme, ID_CTR_ACCESS_ON, 0);
-       LVme_setW(my->lvme, ID_CTR_STANDBY_MODE, 0);
-       LVme_setW(my->lvme, ID_CTR_SW_TO_LUT12, 0);
-       LVme_setW(my->lvme, LUT_CTR_SHOWER_MODE, 0);
-       LVme_setW(my->lvme, ID_CTR_SW_TO_LUT34, 0);
-       LVme_setW(my->lvme, LUT_CTR_SHOWER_MODE, 0);
-       LVme_setW(my->lvme, ID_CTR_ACCESS_OFF, 0);
-       LVme_setW(my->lvme, RC1_ACCESS_ON, 0);
-       LVme_setW(my->lvme, RC1_SHOWER_MODE, 0);
-       LVme_setW(my->lvme, RC1_ACCESS_OFF, 0);
-       LVme_setW(my->lvme, PEDAS_ACCESS_ON, 0);
-       LVme_setW(my->lvme, PEDAS_SHOWER_MODE, 0);
-       LVme_setW(my->lvme, PEDAS_ACCESS_OFF, 0);
-       LVme_setW(my->lvme, LVL2_ACCESS_ON, 0);
-       LVme_setW(my->lvme, LVL2_SHOWER_MODE, 0);
-       LVme_setW(my->lvme, LVL2_STAT_WRITE, 0);
-       LVme_setW(my->lvme, LVL2_ACCESS_OFF, 0);
-       LVme_setW(my->lvme, RC3_ACCESS_ON, 0);
-       LVme_setW(my->lvme, RC3_SHOWER_MODE, 0);
-       LVme_setW(my->lvme, RC3_ACCESS_OFF, 0);
-       LVme_setW(my->lvme, ADDON_ACCESS_ON, 0);
-       LVme_setW(my->lvme, ADDON_SHOWER_MODE, 0);
-       LVme_setW(my->lvme, ADDON_ACCESS_OFF, 0);
+       LVme_setW(my->lvme, ID_CTR_ACCESS_ON,  0);
+       LVme_setW(my->lvme, ID_CTR_STANDBY_MODE,  0);
+       LVme_setW(my->lvme, ID_CTR_SW_TO_LUT12,  0);
+       LVme_setW(my->lvme, LUT_CTR_SHOWER_MODE,  0);
+       LVme_setW(my->lvme, ID_CTR_SW_TO_LUT34,  0);
+       LVme_setW(my->lvme, LUT_CTR_SHOWER_MODE,  0);
+       LVme_setW(my->lvme, ID_CTR_ACCESS_OFF,  0);
+       LVme_setW(my->lvme, RC1_ACCESS_ON,  0);
+       LVme_setW(my->lvme, RC1_SHOWER_MODE,  0);
+       LVme_setW(my->lvme, RC1_ACCESS_OFF,  0);
+       LVme_setW(my->lvme, PEDAS_ACCESS_ON,  0);
+       LVme_setW(my->lvme, PEDAS_SHOWER_MODE,  0);
+       LVme_setW(my->lvme, PEDAS_ACCESS_OFF,  0);
+       LVme_setW(my->lvme, LVL2_ACCESS_ON,  0);
+       LVme_setW(my->lvme, LVL2_SHOWER_MODE,  0);
+       LVme_setW(my->lvme, LVL2_STAT_WRITE,  ZEROSUP);
+       LVme_setW(my->lvme, LVL2_ACCESS_OFF,  0);
+       LVme_setW(my->lvme, RC3_ACCESS_ON,  0);
+       LVme_setW(my->lvme, RC3_SHOWER_MODE,  0);
+       LVme_setW(my->lvme, RC3_ACCESS_OFF,  0);
+       LVme_setW(my->lvme, ADDON_ACCESS_ON,  0);
+       LVme_setW(my->lvme, ADDON_SHOWER_MODE,  0);
+       LVme_setW(my->lvme, ADDON_ACCESS_OFF,  0);
        LVme_setW(my->lvme, LVL2_ACCESS_ON, 0);
 }
 
 
 void HwShip_requestBuffer(HwShip *my) {
   int i;
-#if 0
-  static UInt1 oldBankConfirmed;
 
-  if (oldBankConfirmed == bankConfirmed(my)) {
-    msglog(LOG_ERR, "same bank twice: 0x%02x\n", oldBankConfirmed);
+#if 1
+  if (my->oldBankConfirmed == bankConfirmed(my)) {
+    msglog(LOG_ERR, "same bank twice: 0x%02x\n", my->oldBankConfirmed);
   }
-  oldBankConfirmed = bankConfirmed(my);
+  my->oldBankConfirmed = bankConfirmed(my);
 #endif
 
   msglog(LOG_DEBUG, "wait for data\n");
-  while ((LVme_getW(my->lvme, LVL2_STAT_READ) >> 9 & 0x7f) < 5) {
+  while ((LVme_getW(my->lvme, LVL2_STAT_READ) >> 9 & 0x7f) == 0) {
 #if 1
                        struct timespec tS, *t = &tS;
                        t->tv_sec = 0;
   }
   msglog(LOG_DEBUG, "data available\n");
   i = bankRequested(my) == 1 ? 0 : 1;
-  LVme_setW(my->lvme, LVL2_STAT_WRITE, i << 1);
+  LVme_setW(my->lvme, LVL2_STAT_WRITE, (i << 1) | ZEROSUP);
 
-  my->currAddr = 0x10 + LVL2_OFFSET;
+  my->currAddr = LVL2_OFFSET + 0x4;
 }
 
 int HwShip_isBusy(HwShip *my) {
 int HwShip_readSubEvt(HwShip *my, void *subEvt) {
   UInt4 *data = (UInt4 *)subEvt;
   int firstAddr;
-  int size;
+  size_t size;
   UInt1 trigTag;
-  static UInt1 oldTrigTag;
-  UInt1 checkTrigTag;
-
-  checkTrigTag = LVme_getL(my->lvme, my->currAddr + 0x610);
 
   size = LVme_getL(my->lvme, my->currAddr);
-  my->currAddr += 4;
-  size -= 4;
-
-  trigTag = LVme_getL(my->lvme, my->currAddr) & 0xff;
-#if 0
-  oldTrigTag += 1;
-  if (oldTrigTag != trigTag) {
-    msglog(LOG_ERR, "trigTag sequence: 0x%02x != 0x%02x\n", oldTrigTag, trigTag);
-    oldTrigTag = trigTag;
-  }
-#endif
-  my->currAddr += 4;
-  size -= 4;
-
-#if 1
-  if (checkTrigTag != trigTag) {
-    msglog(LOG_ERR, "trigTag consistency: 0x%02x != 0x%02x\n", checkTrigTag, trigTag);
-  }
-#endif
-  my->currAddr += 4;
-  size -= 4;
-
-  /* BUGBUG workaround missing subEvtHdr in Hardware, set const in Software */
-  *data++ = size + 16;
-  *data++ = 0x00020001;
-  *data++ = 300 + my->name[4] - '0';
-  *data++ = trigTag;
 
   /* copy one sub evt from RC to memory */
   for (firstAddr = my->currAddr; my->currAddr - firstAddr < size; my->currAddr += 4) {
        *data++ = LVme_getL(my->lvme, my->currAddr);
   }
 
-    /* BUGBUG if soft & hardware trigNr differ, HW gets precedence */
-    trigTag = SubEvt_trigNr(subEvt);
-#if 0
-    if (trigTag != (my->trigNr & 0xff)) {
-      msglog(LOG_EMERG,"readSubEvt trigTag differ\n");
-    }
+  trigTag = SubEvt_trigNr(subEvt) & 0xff;
+
+#if 1
+  if ((my->trigNr & 0xff) != trigTag) {
+    msglog(LOG_ERR,
+       "%s trigTag consistency: 0x%02x != 0x%02x offset: 0x%08x\n", my->name, my->trigNr, trigTag, my->currAddr);
+  }
 #endif
-    if (trigTag < (my->trigNr & 0xff)) {
-      my->trigNr += 0x100;
-    }
-    my->trigNr = (my->trigNr & 0xffffff00) | trigTag;
-    SubEvt_setTrigNr(subEvt, my->trigNr << 8 | trigTag);
-    my->trigNr++;
+       /* normal extension of trigger tag */
+       SubEvt_setTrigNr(subEvt, my->trigNr << 8 | trigTag);
+       my->trigNr++;
 
   return 0;
 }