Merge pull request #11 from Mu2e/TestStandPisa

updates from the Pisa test-stand work

build-linux-almalinux9-x86_64_v3-mfjrdk4

@@ -0,0 +1 @@
+/tmp/mu2ecalo/spack-stage/spack-stage-otsdaq-mu2e-calorimeter-v3_01_00-mfjrdk4lrnwstxef5cchtmwameqgs2x6

otsdaq-mu2e-calorimeter/FEInterfaces/CMakeLists.txt

@@ -1,8 +1,9 @@
 
 include(otsdaq::FEInterface)
-
-cet_build_plugin(ROCCalorimeterInterface otsdaq::FEInterface LIBRARIES REG otsdaq_mu2e::ROCPolarFireCoreInterface
- )
+
+cet_make_library(LIBRARY_NAME FEInterfaces SOURCE MZB.C)
+
+cet_build_plugin(ROCCalorimeterInterface otsdaq::FEInterface LIBRARIES REG otsdaq_mu2e::ROCPolarFireCoreInterface otsdaq_mu2e_calorimeter::FEInterfaces)
 
 
 install_headers()

otsdaq-mu2e-calorimeter/FEInterfaces/MZB.C

@@ -0,0 +1,111 @@
+
+#define GNU_COMP
+#include "otsdaq-mu2e-calorimeter/FEInterfaces/MZB.h"
+
+
+uint8_t* MZB_Encode_CMD_Command_raw(MZB_OSCMDCODE_t cmdCode, float* params) {
+
+    int i;
+
+
+    // Create structure and fill only to ease the checksum calculation
+
+    #ifdef GNU_COMP
+        static struct  __attribute__ ((__packed__)) ems {
+    #else
+        __packed __align(4) struct ems {
+    #endif
+            short dummy;
+            short adr;
+
+            #ifdef GNU_COMP
+                struct __attribute__ ((__packed__)) {
+            #else
+                __packed struct {
+            #endif
+                    unsigned short functionReq_tag;  // 'CD'
+                    unsigned short functionReq;
+                    float P[CT_MAXP];
+
+            #ifdef GNU_COMP
+                // } __attribute__((packed, aligned(4))) 
+                } __attribute__ ((aligned (4))) 
+            #else        
+                } 
+            #endif
+                cmdReq;
+            unsigned chksum;
+    #ifdef GNU_COMP
+        // } __attribute__((packed, aligned(4))) 
+        } __attribute__ ((aligned (4))) 
+    #else    
+        } 
+    #endif
+        em;
+
+
+    // *** Fill the structure ***
+
+
+    em.adr = offsetof(EE_DATABUF_t, functionReq_tag);
+
+    // Structure id for the extended command request ('CD')
+    em.cmdReq.functionReq_tag = 'C' | ('D' << 8);
+
+    // Command request (enumerated)
+    em.cmdReq.functionReq = cmdCode | 0x8000;
+
+
+    // 9 parameters (float)
+    for (i = 0; i < CT_MAXP; i++) {
+        em.cmdReq.P[i] = params[i];
+    }
+
+    // Checksum
+    em.chksum = 1 + (~ees_chksum((void *)&em.cmdReq, sizeof(em.cmdReq)));
+
+    // Print for debug
+    int debug = 0;
+    if (debug){
+        uint8_t *p = (uint8_t*)&em.adr;
+        for(size_t i=0; i < (sizeof(em) - offsetof(struct ems, adr)); i+=8){
+            for(int j=0; j<8; j++){
+                printf("%02x ", *p++);
+            }
+            printf("\n");
+        }
+    }
+
+
+
+    return (uint8_t*)&em.adr;
+
+}
+
+unsigned ees_chksum(void *ptr, int len) {
+  unsigned *src = (unsigned*)ptr;
+  unsigned sum;
+  unsigned tmp;
+
+  for(sum=0; len>=4; len-=4)
+    sum += *src++;
+
+  if (len) {
+    tmp = 0;
+    memcpy(&tmp, src, len);
+    sum += tmp;
+  }
+
+  return sum;
+}
+
+MZB_OSCMDCODE_t mz_string_to_enum(const char* str){
+    for (int i = 0; i < sizeof(code_map) / sizeof(code_map[0]); i++) {
+        if (code_map[i].str == str) {
+            return code_map[i].code;
+        }
+    }
+
+    return SYNTAX_ERROR;
+
+}