Add SCALE function block for signal processing

- Added a new SCALE function block for scaling signals in the SIGNALPROCESSING module. - Included necessary header and source files for the SCALE function block implementation.
eclipse-4diac · Sep 28, 2024 · 981128a · 981128a
1 parent 2ed9dc5
commit 981128a
Show file tree

Hide file tree

Showing 3 changed files with 252 additions and 1 deletion.
diff --git a/src/modules/signalprocessing/CMakeLists.txt b/src/modules/signalprocessing/CMakeLists.txt
@@ -22,4 +22,5 @@ forte_add_include_directories(${CMAKE_CURRENT_SOURCE_DIR})
 forte_add_sourcefile_hcpp(DualHysteresis_fbt)
 forte_add_sourcefile_hcpp(FIELDBUS_WORD_TO_PERCENT_fct)
 forte_add_sourcefile_hcpp(FIELDBUS_PERCENT_TO_WORD_fct)
-forte_add_sourcefile_hcpp(FIELDBUS_SIGNAL_gcf)
+forte_add_sourcefile_hcpp(FIELDBUS_SIGNAL_gcf)
+forte_add_sourcefile_hcpp(SCALE_fct)
diff --git a/src/modules/signalprocessing/SCALE_fct.cpp b/src/modules/signalprocessing/SCALE_fct.cpp
@@ -0,0 +1,153 @@
+/*************************************************************************  
+ *** Copyright (c) 2024 HR Agrartechnik GmbH
+ *** This program and the accompanying materials are made available under the  
+ *** terms of the Eclipse Public License 2.0 which is available at  
+ *** http://www.eclipse.org/legal/epl-2.0.  
+ ***  
+ *** SPDX-License-Identifier: EPL-2.0  
+ ***
+ *** This file was generated using the 4DIAC FORTE Export Filter V1.0.x NG!
+ ***
+ *** Name: SCALE
+ *** Description: Scaling Function Block
+ *** Version:
+ ***     1.0: 2024-09-19/Franz Höpfinger - HR Agrartechnik GmbH -
+ *************************************************************************/
+
+#include "SCALE_fct.h"
+#ifdef FORTE_ENABLE_GENERATED_SOURCE_CPP
+#include "SCALE_fct_gen.cpp"
+#endif
+
+#include "forte_real.h"
+#include "iec61131_functions.h"
+#include "forte_array_common.h"
+#include "forte_array.h"
+#include "forte_array_fixed.h"
+#include "forte_array_variable.h"
+#include "SCALE_fct.h"
+
+DEFINE_FIRMWARE_FB(FORTE_signalprocessing__SCALE, g_nStringIdsignalprocessing__SCALE)
+
+const CStringDictionary::TStringId FORTE_signalprocessing__SCALE::scmDataInputNames[] = {g_nStringIdIN, g_nStringIdMAX_IN, g_nStringIdMIN_IN, g_nStringIdMAX_OUT, g_nStringIdMIN_OUT};
+const CStringDictionary::TStringId FORTE_signalprocessing__SCALE::scmDataInputTypeIds[] = {g_nStringIdREAL, g_nStringIdREAL, g_nStringIdREAL, g_nStringIdREAL, g_nStringIdREAL};
+const CStringDictionary::TStringId FORTE_signalprocessing__SCALE::scmDataOutputNames[] = {g_nStringId};
+const CStringDictionary::TStringId FORTE_signalprocessing__SCALE::scmDataOutputTypeIds[] = {g_nStringIdREAL};
+const TDataIOID FORTE_signalprocessing__SCALE::scmEIWith[] = {0, 1, 2, 3, 4, scmWithListDelimiter};
+const TForteInt16 FORTE_signalprocessing__SCALE::scmEIWithIndexes[] = {0};
+const CStringDictionary::TStringId FORTE_signalprocessing__SCALE::scmEventInputNames[] = {g_nStringIdREQ};
+const TDataIOID FORTE_signalprocessing__SCALE::scmEOWith[] = {0, scmWithListDelimiter};
+const TForteInt16 FORTE_signalprocessing__SCALE::scmEOWithIndexes[] = {0};
+const CStringDictionary::TStringId FORTE_signalprocessing__SCALE::scmEventOutputNames[] = {g_nStringIdCNF};
+const SFBInterfaceSpec FORTE_signalprocessing__SCALE::scmFBInterfaceSpec = {
+  1, scmEventInputNames, scmEIWith, scmEIWithIndexes,
+  1, scmEventOutputNames, scmEOWith, scmEOWithIndexes,
+  5, scmDataInputNames, scmDataInputTypeIds,
+  1, scmDataOutputNames, scmDataOutputTypeIds,
+  0, nullptr,
+  0, nullptr
+};
+
+FORTE_signalprocessing__SCALE::FORTE_signalprocessing__SCALE(const CStringDictionary::TStringId paInstanceNameId, forte::core::CFBContainer &paContainer) :
+    CFunctionBlock(paContainer, scmFBInterfaceSpec, paInstanceNameId),
+    var_conn_(var_),
+    conn_CNF(this, 0),
+    conn_IN(nullptr),
+    conn_MAX_IN(nullptr),
+    conn_MIN_IN(nullptr),
+    conn_MAX_OUT(nullptr),
+    conn_MIN_OUT(nullptr),
+    conn_(this, 0, &var_conn_) {
+}
+
+void FORTE_signalprocessing__SCALE::setInitialValues() {
+  var_IN = 0_REAL;
+  var_MAX_IN = 0_REAL;
+  var_MIN_IN = 0_REAL;
+  var_MAX_OUT = 0_REAL;
+  var_MIN_OUT = 0_REAL;
+  var_ = 0_REAL;
+}
+
+void FORTE_signalprocessing__SCALE::readInputData(const TEventID paEIID) {
+  switch(paEIID) {
+    case scmEventREQID: {
+      readData(0, var_IN, conn_IN);
+      readData(1, var_MAX_IN, conn_MAX_IN);
+      readData(2, var_MIN_IN, conn_MIN_IN);
+      readData(3, var_MAX_OUT, conn_MAX_OUT);
+      readData(4, var_MIN_OUT, conn_MIN_OUT);
+      break;
+    }
+    default:
+      break;
+  }
+}
+
+void FORTE_signalprocessing__SCALE::writeOutputData(const TEventID paEIID) {
+  switch(paEIID) {
+    case scmEventCNFID: {
+      writeData(0, var_, conn_);
+      break;
+    }
+    default:
+      break;
+  }
+}
+
+CIEC_ANY *FORTE_signalprocessing__SCALE::getDI(const size_t paIndex) {
+  switch(paIndex) {
+    case 0: return &var_IN;
+    case 1: return &var_MAX_IN;
+    case 2: return &var_MIN_IN;
+    case 3: return &var_MAX_OUT;
+    case 4: return &var_MIN_OUT;
+  }
+  return nullptr;
+}
+
+CIEC_ANY *FORTE_signalprocessing__SCALE::getDO(const size_t paIndex) {
+  switch(paIndex) {
+    case 0: return &var_;
+  }
+  return nullptr;
+}
+
+CEventConnection *FORTE_signalprocessing__SCALE::getEOConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_CNF;
+  }
+  return nullptr;
+}
+
+CDataConnection **FORTE_signalprocessing__SCALE::getDIConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_IN;
+    case 1: return &conn_MAX_IN;
+    case 2: return &conn_MIN_IN;
+    case 3: return &conn_MAX_OUT;
+    case 4: return &conn_MIN_OUT;
+  }
+  return nullptr;
+}
+
+CDataConnection *FORTE_signalprocessing__SCALE::getDOConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_;
+  }
+  return nullptr;
+}
+
+void FORTE_signalprocessing__SCALE::executeEvent(const TEventID, CEventChainExecutionThread *const paECET) {
+  var_ = func_SCALE(var_IN, var_MAX_IN, var_MIN_IN, var_MAX_OUT, var_MIN_OUT);
+  sendOutputEvent(scmEventCNFID, paECET);
+}
+
+CIEC_REAL func_SCALE(CIEC_REAL st_lv_IN, CIEC_REAL st_lv_MAX_IN, CIEC_REAL st_lv_MIN_IN, CIEC_REAL st_lv_MAX_OUT, CIEC_REAL st_lv_MIN_OUT) {
+  CIEC_REAL st_ret_val = 0_REAL;
+
+  #line 13 "SCALE.fct"
+  st_ret_val = func_ADD<CIEC_REAL>(func_DIV<CIEC_REAL>(func_MUL<CIEC_REAL>(func_SUB<CIEC_REAL>(st_lv_IN, st_lv_MIN_IN), func_SUB<CIEC_REAL>(st_lv_MAX_OUT, st_lv_MIN_OUT)), func_SUB<CIEC_REAL>(st_lv_MAX_IN, st_lv_MIN_IN)), st_lv_MIN_OUT);
+
+  return st_ret_val;
+}
diff --git a/src/modules/signalprocessing/SCALE_fct.h b/src/modules/signalprocessing/SCALE_fct.h
@@ -0,0 +1,97 @@
+/*************************************************************************  
+ *** Copyright (c) 2024 HR Agrartechnik GmbH
+ *** This program and the accompanying materials are made available under the  
+ *** terms of the Eclipse Public License 2.0 which is available at  
+ *** http://www.eclipse.org/legal/epl-2.0.  
+ ***  
+ *** SPDX-License-Identifier: EPL-2.0  
+ ***
+ *** This file was generated using the 4DIAC FORTE Export Filter V1.0.x NG!
+ ***
+ *** Name: SCALE
+ *** Description: Scaling Function Block
+ *** Version:
+ ***     1.0: 2024-09-19/Franz Höpfinger - HR Agrartechnik GmbH -
+ *************************************************************************/
+
+#pragma once
+
+#include "funcbloc.h"
+#include "forte_real.h"
+#include "iec61131_functions.h"
+#include "forte_array_common.h"
+#include "forte_array.h"
+#include "forte_array_fixed.h"
+#include "forte_array_variable.h"
+
+class FORTE_signalprocessing__SCALE final : public CFunctionBlock {
+  DECLARE_FIRMWARE_FB(FORTE_signalprocessing__SCALE)
+
+  private:
+    static const CStringDictionary::TStringId scmDataInputNames[];
+    static const CStringDictionary::TStringId scmDataInputTypeIds[];
+    static const CStringDictionary::TStringId scmDataOutputNames[];
+    static const CStringDictionary::TStringId scmDataOutputTypeIds[];
+    static const TEventID scmEventREQID = 0;
+    static const TDataIOID scmEIWith[];
+    static const TForteInt16 scmEIWithIndexes[];
+    static const CStringDictionary::TStringId scmEventInputNames[];
+    static const TEventID scmEventCNFID = 0;
+    static const TDataIOID scmEOWith[];
+    static const TForteInt16 scmEOWithIndexes[];
+    static const CStringDictionary::TStringId scmEventOutputNames[];
+
+    static const SFBInterfaceSpec scmFBInterfaceSpec;
+
+    void executeEvent(TEventID paEIID, CEventChainExecutionThread *const paECET) override;
+
+    void readInputData(TEventID paEIID) override;
+    void writeOutputData(TEventID paEIID) override;
+    void setInitialValues() override;
+
+  public:
+    FORTE_signalprocessing__SCALE(CStringDictionary::TStringId paInstanceNameId, forte::core::CFBContainer &paContainer);
+
+    CIEC_REAL var_IN;
+    CIEC_REAL var_MAX_IN;
+    CIEC_REAL var_MIN_IN;
+    CIEC_REAL var_MAX_OUT;
+    CIEC_REAL var_MIN_OUT;
+
+    CIEC_REAL var_;
+
+    CIEC_REAL var_conn_;
+
+    CEventConnection conn_CNF;
+
+    CDataConnection *conn_IN;
+    CDataConnection *conn_MAX_IN;
+    CDataConnection *conn_MIN_IN;
+    CDataConnection *conn_MAX_OUT;
+    CDataConnection *conn_MIN_OUT;
+
+    CDataConnection conn_;
+
+    CIEC_ANY *getDI(size_t) override;
+    CIEC_ANY *getDO(size_t) override;
+    CEventConnection *getEOConUnchecked(TPortId) override;
+    CDataConnection **getDIConUnchecked(TPortId) override;
+    CDataConnection *getDOConUnchecked(TPortId) override;
+
+    void evt_REQ(const CIEC_REAL &paIN, const CIEC_REAL &paMAX_IN, const CIEC_REAL &paMIN_IN, const CIEC_REAL &paMAX_OUT, const CIEC_REAL &paMIN_OUT, CIEC_REAL &pa) {
+      var_IN = paIN;
+      var_MAX_IN = paMAX_IN;
+      var_MIN_IN = paMIN_IN;
+      var_MAX_OUT = paMAX_OUT;
+      var_MIN_OUT = paMIN_OUT;
+      executeEvent(scmEventREQID, nullptr);
+      pa = var_;
+    }
+
+    void operator()(const CIEC_REAL &paIN, const CIEC_REAL &paMAX_IN, const CIEC_REAL &paMIN_IN, const CIEC_REAL &paMAX_OUT, const CIEC_REAL &paMIN_OUT, CIEC_REAL &pa) {
+      evt_REQ(paIN, paMAX_IN, paMIN_IN, paMAX_OUT, paMIN_OUT, pa);
+    }
+};
+
+CIEC_REAL func_SCALE(CIEC_REAL st_lv_IN, CIEC_REAL st_lv_MAX_IN, CIEC_REAL st_lv_MIN_IN, CIEC_REAL st_lv_MAX_OUT, CIEC_REAL st_lv_MIN_OUT);
+