Fix checkLinkStatus method to works with more then one hybrid

.gitignore

@@ -12,3 +12,4 @@ envPaths
 *.db.d
 build.sh
 build
+.iocsh_history

cmds/st.cmd

@@ -29,7 +29,7 @@ dbLoadRecords("$(vmmTbl_DB)/vmm_tbl.db", "P=$(P), R=NDet-VMM-001:, PORT=RMM, RIN
 iocInit()
 
 dbpf $(P)$(R)Temperature-R.SCAN 2
-#dbpf $(P)$(R)ProcessPktCount-S.SCAN 2
+dbpf $(P)$(R)ProcessPktCount-S.SCAN 2
 dbpf $(P)$(R)VoltVCCINT-R.SCAN 2
 dbpf $(P)$(R)VoltVCC1V8-R.SCAN 2
 dbpf $(P)$(R)VoltVADJ1V8-R.SCAN 2
@@ -37,4 +37,4 @@ dbpf $(P)$(R)VoltVCC1V2-R.SCAN 2
 dbpf $(P)$(R)VoltMGTAVCC-R.SCAN 2
 dbpf $(P)$(R)VoltMGTAVTT-R.SCAN 2
 dbpf $(P)$(R)VoltVCCINTIOBRAM-R.SCAN 2
-#
+

vmmTblApp/src/vmm_config.cpp

@@ -19,16 +19,14 @@ FENConfigModule::~FENConfigModule() {
 }
 
 void FENConfigModule::acquire(bool acquire) {
-  std::string message;
-  std::vector<std::string> linkStatus;
   if (acquire) {
     enableAcquisition(false);
     sendAll(true);
     enableAcquisition(true);
-    checkLinkStatus(message, linkStatus);
+    checkLinkStatus(linkStatus);
   } else {
     enableAcquisition(false);
-    checkLinkStatus(message, linkStatus);
+    checkLinkStatus(linkStatus);
   }
 }
 
@@ -52,22 +50,17 @@ void FENConfigModule::enableAcquisition(bool enabled) {
   pFEN->userRegWrite("sc_acq_on_off", 0x00000000);
 }
 
-void FENConfigModule::checkLinkStatus(std::string& message, std::vector<std::string>& linkStatus) {
-  linkStatus.clear();
-  for (int n = 0; n < HYBRIDS_PER_FEN; n++) linkStatus.push_back("0");
-
+void FENConfigModule::checkLinkStatus(uint8_t* linkStatus) {
   uint32_t result = readWriteRegs("sc_app_link_status", 0, "app_link_status");
 
-  std::stringstream ss;
+  std::stringstream tmpStream;
+  tmpStream << std::hex << result;
+  std::string str = tmpStream.str();
 
-  for (int n = 0; n < HYBRIDS_PER_FEN; n++) {
-    if (isHybridEnabled(n)) {
-      linkStatus[n] = std::to_string(result);
-      ss << "hybr. " + std::to_string(n) + ": " + linkStatus[n] << std::endl;
-    }
+  for (size_t n = 0; n < str.size(); n++) {
+    linkStatus[n] = static_cast<uint8_t>(std::stoi(str.substr(str.size() - 1 - n, 1)));
+    std::cout << "hybr. " << n << ": " << static_cast<int>(linkStatus[n]) << std::endl;
   }
-  message = ss.str();
-  std::cout << "Message: " << message << std::endl;
 }
 
 void FENConfigModule::configFEN() {

vmmTblApp/src/vmm_config.h

@@ -32,7 +32,8 @@ private:
   bool enabled_hybrids[HYBRIDS_PER_FEN] = {};
   uint32_t readWriteRegs(std::string command_reg, int index, std::string read_reg);
   uint16_t getChMap();
-  void checkLinkStatus(std::string& message, std::vector<std::string>& linkStatus);
+  void checkLinkStatus(uint8_t* linkStatus);
   void sendAll(bool useConfigCheck);
   void enableAcquisition(bool enabled);
+  uint8_t linkStatus[HYBRIDS_PER_FEN];
 };