Move files

src/ecmcDAQWrap.cpp

@@ -0,0 +1,184 @@
+/*************************************************************************\
+* Copyright (c) 2019 European Spallation Source ERIC
+* ecmc is distributed subject to a Software License Agreement found
+* in file LICENSE that is included with this distribution. 
+*
+*  ecmcDAQWrap.cpp
+*
+*  Created on: Sept 21, 2020
+*      Author: anderssandstrom
+*      Credits to  https://github.com/sgreg/dynamic-loading 
+*
+\*************************************************************************/
+
+// Needed to get headers in ecmc right...
+#define ECMC_IS_PLUGIN
+
+#include <vector>
+#include <stdexcept>
+#include <string>
+#include "ecmcDAQWrap.h"
+#include "ecmcDAQChannel.h"
+#include "ecmcDAQDefs.h"
+#include <epicsExport.h>
+
+#define ECMC_PLUGIN_PORTNAME_PREFIX "PLUGIN.DAQ"
+#define ECMC_PLUGIN_DAQ_ERROR_CODE 1
+
+static std::vector<ecmcDAQChannel*>  channels;
+static int                    channelCounter = 0;
+
+int createDAQ(char* name) {
+
+  // create new ecmcFFT object
+  ecmcDAQChannel* channel = NULL;
+
+  try {
+    channel = new ecmcDAQChannel(name);
+  }
+  catch(std::exception& e) {
+    if(scope) {
+      delete channel;
+    }
+    printf("Exception: %s. Plugin will unload.\n",e.what());
+    return ECMC_PLUGIN_DAQ_ERROR_CODE;
+  }
+  
+  scopes.push_back(scope);
+  channelCounter++;
+
+  return 0;
+}
+
+void deleteAllDAQs() {
+  for(std::vector<ecmcDAQChannel*>::iterator pDAQChannel = scopes.begin(); pDAQChannel != scopes.end(); ++pDAQChannel) {
+    if(*pDAQChannel) {
+      delete (*pDAQChannel);
+    }
+  }
+}
+
+int  linkDataToDAQs() {
+  for(std::vector<ecmcDAQChannel*>::iterator pDAQChannel = scopes.begin(); pDAQChannel != scopes.end(); ++pDAQChannel) {
+    if(*pDAQChannel) {
+      try {
+        (*pDAQChannel)->connectToDataSources();
+      }
+      catch(std::exception& e) {
+        printf("Exception: %s. Plugin will unload.\n",e.what());
+        return ECMC_PLUGIN_DAQ_ERROR_CODE;
+      }
+    }
+  }
+  return 0;
+}
+
+int enableDAQ(int scopeIndex, int enable) {
+  try {
+    scopes.at(scopeIndex)->setEnable(enable);
+  }
+  catch(std::exception& e) {
+    printf("Exception: %s. DAQ index out of range.\n",e.what());
+    return ECMC_PLUGIN_DAQ_ERROR_CODE;
+  }
+  return 0;
+}
+
+int executeDAQCs() {
+  try {
+    for(std::vector<ecmcDAQChannel*>::iterator pDAQChannel = scopes.begin(); pDAQChannel != scopes.end(); ++pDAQChannel) {
+      if(*pDAQChannel) {
+        (*pDAQChannel)->execute();
+      }
+     }
+  }
+  catch(std::exception& e) {
+    printf("Exception: %s.\n",e.what());
+    return ECMC_PLUGIN_DAQ_ERROR_CODE;
+  }  
+  return 0;
+}
+
+
+
+
+/** 
+ * EPICS iocsh shell command: ecmcAddDataType1ToChannel
+*/
+void ecmcAddDataType1ToChannelPrintHelp() {
+  printf("\n");
+  printf("       Use ecmcAddDataType1ToChannel(<ch_name>, <axis_index>)\n");
+  printf("          <ch_name>      : Name of channel to add data to.\n");
+  printf("          <Axis id>      : Axis index to add.\n");
+  printf("          <velo limit>   : Axis standstill velo limit [unit of axis].\n");
+  printf("          <time>         : Time for axis to be below velo limit [ms].\n");
+  printf("\n");
+}
+
+int ecmcAddAxisToSafetyGroup(const char* name, int axis_id, double velo_lim, int stand_still_time) {
+  if(!name) {    
+    ecmcAddAxisToSafetyGroupPrintHelp();
+    return asynError;
+  }
+
+  if(strcmp(name,"-h") == 0 || strcmp(name,"--help") == 0 ) {
+    ecmcAddAxisToSafetyGroupPrintHelp();
+    return asynSuccess;
+  }
+
+  if(axis_id <= 0) {
+    printf("Error: Invalid axis id.\n");
+    exit(EXIT_FAILURE);
+  }
+
+  if(velo_lim < 0) {
+    printf("Error: Invalid velocity limit.\n");
+    exit(EXIT_FAILURE);
+  }
+
+  if(stand_still_time < 0) {
+    printf("Error: Invalid stand still filter time.\n");
+    exit(EXIT_FAILURE);
+  }
+  try {
+    return addAxisToSafetyGroup(name,axis_id, velo_lim, stand_still_time);
+  }
+  catch(std::exception& e) {
+    printf("Exception: %s. Add axis to safety group failed.\n",e.what());
+    exit(EXIT_FAILURE);
+  }
+
+  return asynSuccess;
+}
+
+static const iocshArg initArg0_2 =
+{ "Group name", iocshArgString };
+static const iocshArg initArg1_2 =
+{ "Axis id []", iocshArgInt };
+static const iocshArg initArg2_2 =
+{ "Velo limit [unit same as axis cfg]", iocshArgDouble };
+static const iocshArg initArg3_2 =
+{ "Velo stand still filter time [ms]", iocshArgInt };
+
+static const iocshArg *const initArgs_2[]  = { &initArg0_2, 
+                                               &initArg1_2,
+                                               &initArg2_2,
+                                               &initArg3_2};
+
+static const iocshFuncDef    initFuncDef_2 = { "ecmcAddAxisToSafetyGroup", 4, initArgs_2};
+static void initCallFunc_2(const iocshArgBuf *args) {
+  ecmcAddAxisToSafetyGroup(args[0].sval, args[1].ival, args[2].dval, args[3].ival);
+}
+
+void ecmcSafetyPlgRegister(void) {
+  iocshRegister(&initFuncDef_1,  initCallFunc_1);
+  iocshRegister(&initFuncDef_2,  initCallFunc_2);
+}
+
+epicsExportRegistrar(ecmcSafetyPlgRegister);
+
+
+
+
+
+