added FMC control

slsDetectorServers/slsDetectorServer/src/XILINX_FMC.c

@@ -0,0 +1,64 @@
+// SPDX-License-Identifier: LGPL-3.0-or-other
+// Copyright (C) 2021 Contributors to the SLS Detector Package
+#include "XILINX_FMC.h"
+#include "arm64.h"
+#include "clogger.h"
+#include <math.h>
+#include <stdbool.h>
+#include <unistd.h>
+
+// clang-format off
+#define FMC_BASE_PATH "/root/fmc/"
+#define FMC_VADJ_EN "FMC_VADJ_EN"
+#define FMCP_VADJ_EN "FMCP_VADJ_EN"
+#define FMCP_3V3_EN "FMCP_3V3_EN"
+#define FMC_3V3_EN "FMC_3V3_EN"
+#define FMC_12V_EN "FMC_12V_EN"
+#define FMCP_12V_EN "FMCP_12V_EN"
+
+static const char *fmc_files[] = {
+    FMC_VADJ_EN,
+    FMCP_VADJ_EN,
+    FMCP_3V3_EN,
+    FMC_3V3_EN,
+    FMC_12V_EN,
+    FMCP_12V_EN
+};
+// clang-format on
+
+void XILINX_FMC_enable_all() {
+    LOG(logINFOBLUE, ("enable FMC power\n"));
+    #ifdef VIRTUAL
+        return;
+    #endif
+    char full_path[64];
+    for (size_t i = 0; i < sizeof(fmc_files) / sizeof(fmc_files[0]); ++i) {
+        snprintf(full_path, sizeof(full_path), "%s%s", FMC_BASE_PATH, fmc_files[i]);
+        FILE *fp = fopen(full_path, "w");
+        if (fp == NULL) {
+            LOG(logERROR,("XILINX_FMC: enable Error\n"));
+            continue;
+        }
+
+        fprintf(fp, "1\n");
+        fclose(fp);
+    }
+}
+
+void XILINX_FMC_disable_all() {
+    LOG(logINFOBLUE, ("disable FMC power\n"));
+    #ifdef VIRTUAL
+        return;
+    #endif
+    char full_path[64];
+    for (size_t i = 0; i < sizeof(fmc_files) / sizeof(fmc_files[0]); ++i) {
+        snprintf(full_path, sizeof(full_path), "%s%s", FMC_BASE_PATH, fmc_files[i]);
+        FILE *fp = fopen(full_path, "w");
+        if (fp == NULL) {
+            LOG(logERROR,("XILINX_FMC: disable Error\n"));
+            continue;
+        }
+        fprintf(fp, "0\n");
+        fclose(fp);
+    }
+}