#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;
}