Add STEPPER functionality, event handling, and algorithms. New file f…

…or STEPPER function block added. Add STEPPER functionality, event handling, and algorithms. New file for STEPPER function block added. STEPPER is a Setpoint Stepper like known from Cruise Control in cars.
eclipse-4diac · Sep 23, 2024 · 35a41ce · 35a41ce
1 parent e7c4ce8
commit 35a41ce
Show file tree

Hide file tree

Showing 3 changed files with 430 additions and 1 deletion.
diff --git a/src/modules/signalprocessing/CMakeLists.txt b/src/modules/signalprocessing/CMakeLists.txt
@@ -22,4 +22,7 @@ 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) // other PR
+# forte_add_sourcefile_hcpp(SCALE_LIM_fct) // other PR
+forte_add_sourcefile_hcpp(STEPPER_fbt)
diff --git a/src/modules/signalprocessing/STEPPER_fbt.cpp b/src/modules/signalprocessing/STEPPER_fbt.cpp
@@ -0,0 +1,255 @@
+/*************************************************************************  
+ *** 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: STEPPER
+ *** Description: Step up and down Values
+ *** Version:
+ ***     1.0: 2024-09-20/Franz Höpfinger - HR Agrartechnik GmbH -
+ *************************************************************************/
+
+#include "STEPPER_fbt.h"
+#ifdef FORTE_ENABLE_GENERATED_SOURCE_CPP
+#include "STEPPER_fbt_gen.cpp"
+#endif
+
+#include "forte_any_elementary_variant.h"
+#include "forte_any_num_variant.h"
+#include "forte_dint.h"
+#include "iec61131_functions.h"
+#include "forte_array_common.h"
+#include "forte_array.h"
+#include "forte_array_fixed.h"
+#include "forte_array_variable.h"
+
+DEFINE_FIRMWARE_FB(FORTE_signalprocessing__STEPPER, g_nStringIdsignalprocessing__STEPPER)
+
+const CStringDictionary::TStringId FORTE_signalprocessing__STEPPER::scmDataInputNames[] = {g_nStringIdPV, g_nStringIdVAL_ZERO, g_nStringIdSLOW, g_nStringIdFAST, g_nStringIdVAL_FULL};
+const CStringDictionary::TStringId FORTE_signalprocessing__STEPPER::scmDataInputTypeIds[] = {g_nStringIdDINT, g_nStringIdDINT, g_nStringIdDINT, g_nStringIdDINT, g_nStringIdDINT};
+const CStringDictionary::TStringId FORTE_signalprocessing__STEPPER::scmDataOutputNames[] = {g_nStringIdOUT};
+const CStringDictionary::TStringId FORTE_signalprocessing__STEPPER::scmDataOutputTypeIds[] = {g_nStringIdDINT};
+const TDataIOID FORTE_signalprocessing__STEPPER::scmEIWith[] = {1, scmWithListDelimiter, 2, scmWithListDelimiter, 3, scmWithListDelimiter, 2, scmWithListDelimiter, 3, scmWithListDelimiter, 4, scmWithListDelimiter, 0, scmWithListDelimiter};
+const TForteInt16 FORTE_signalprocessing__STEPPER::scmEIWithIndexes[] = {0, 2, 4, 6, 8, 10, 12};
+const CStringDictionary::TStringId FORTE_signalprocessing__STEPPER::scmEventInputNames[] = {g_nStringIdZERO, g_nStringIdUP_SLOW, g_nStringIdUP_FAST, g_nStringIdDOWN_SLOW, g_nStringIdDOWN_FAST, g_nStringIdFULL, g_nStringIdLOAD};
+const TDataIOID FORTE_signalprocessing__STEPPER::scmEOWith[] = {0, scmWithListDelimiter};
+const TForteInt16 FORTE_signalprocessing__STEPPER::scmEOWithIndexes[] = {0};
+const CStringDictionary::TStringId FORTE_signalprocessing__STEPPER::scmEventOutputNames[] = {g_nStringIdCNF};
+const SFBInterfaceSpec FORTE_signalprocessing__STEPPER::scmFBInterfaceSpec = {
+  7, scmEventInputNames, scmEIWith, scmEIWithIndexes,
+  1, scmEventOutputNames, scmEOWith, scmEOWithIndexes,
+  5, scmDataInputNames, scmDataInputTypeIds,
+  1, scmDataOutputNames, scmDataOutputTypeIds,
+  0, nullptr,
+  0, nullptr
+};
+
+FORTE_signalprocessing__STEPPER::FORTE_signalprocessing__STEPPER(const CStringDictionary::TStringId paInstanceNameId, forte::core::CFBContainer &paContainer) :
+    CSimpleFB(paContainer, scmFBInterfaceSpec, paInstanceNameId, nullptr),
+    var_conn_OUT(var_OUT),
+    conn_CNF(this, 0),
+    conn_PV(nullptr),
+    conn_VAL_ZERO(nullptr),
+    conn_SLOW(nullptr),
+    conn_FAST(nullptr),
+    conn_VAL_FULL(nullptr),
+    conn_OUT(this, 0, &var_conn_OUT) {
+}
+
+void FORTE_signalprocessing__STEPPER::setInitialValues() {
+  var_PV = 0_DINT;
+  var_VAL_ZERO = 0_DINT;
+  var_SLOW = 0_DINT;
+  var_FAST = 0_DINT;
+  var_VAL_FULL = 0_DINT;
+  var_OUT = 0_DINT;
+}
+
+void FORTE_signalprocessing__STEPPER::executeEvent(const TEventID paEIID, CEventChainExecutionThread *const paECET) {
+  switch(paEIID) {
+    case scmEventZEROID:
+      alg_ZERO();
+      break;
+    case scmEventUP_SLOWID:
+      alg_UP_SLOW();
+      break;
+    case scmEventUP_FASTID:
+      alg_UP_FAST();
+      break;
+    case scmEventDOWN_SLOWID:
+      alg_DOWN_SLOW();
+      break;
+    case scmEventDOWN_FASTID:
+      alg_DOWN_FAST();
+      break;
+    case scmEventFULLID:
+      alg_FULL();
+      break;
+    case scmEventLOADID:
+      alg_LOAD();
+      break;
+    default:
+      break;
+  }
+  sendOutputEvent(scmEventCNFID, paECET);
+}
+
+void FORTE_signalprocessing__STEPPER::readInputData(const TEventID paEIID) {
+  switch(paEIID) {
+    case scmEventZEROID: {
+      readData(1, var_VAL_ZERO, conn_VAL_ZERO);
+      break;
+    }
+    case scmEventUP_SLOWID: {
+      readData(2, var_SLOW, conn_SLOW);
+      break;
+    }
+    case scmEventUP_FASTID: {
+      readData(3, var_FAST, conn_FAST);
+      break;
+    }
+    case scmEventDOWN_SLOWID: {
+      readData(2, var_SLOW, conn_SLOW);
+      break;
+    }
+    case scmEventDOWN_FASTID: {
+      readData(3, var_FAST, conn_FAST);
+      break;
+    }
+    case scmEventFULLID: {
+      readData(4, var_VAL_FULL, conn_VAL_FULL);
+      break;
+    }
+    case scmEventLOADID: {
+      readData(0, var_PV, conn_PV);
+      break;
+    }
+    default:
+      break;
+  }
+}
+
+void FORTE_signalprocessing__STEPPER::writeOutputData(const TEventID paEIID) {
+  switch(paEIID) {
+    case scmEventCNFID: {
+      writeData(0, var_OUT, conn_OUT);
+      break;
+    }
+    default:
+      break;
+  }
+}
+
+CIEC_ANY *FORTE_signalprocessing__STEPPER::getDI(const size_t paIndex) {
+  switch(paIndex) {
+    case 0: return &var_PV;
+    case 1: return &var_VAL_ZERO;
+    case 2: return &var_SLOW;
+    case 3: return &var_FAST;
+    case 4: return &var_VAL_FULL;
+  }
+  return nullptr;
+}
+
+CIEC_ANY *FORTE_signalprocessing__STEPPER::getDO(const size_t paIndex) {
+  switch(paIndex) {
+    case 0: return &var_OUT;
+  }
+  return nullptr;
+}
+
+CEventConnection *FORTE_signalprocessing__STEPPER::getEOConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_CNF;
+  }
+  return nullptr;
+}
+
+CDataConnection **FORTE_signalprocessing__STEPPER::getDIConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_PV;
+    case 1: return &conn_VAL_ZERO;
+    case 2: return &conn_SLOW;
+    case 3: return &conn_FAST;
+    case 4: return &conn_VAL_FULL;
+  }
+  return nullptr;
+}
+
+CDataConnection *FORTE_signalprocessing__STEPPER::getDOConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_OUT;
+  }
+  return nullptr;
+}
+
+CIEC_ANY *FORTE_signalprocessing__STEPPER::getVarInternal(size_t) {
+  return nullptr;
+}
+
+void FORTE_signalprocessing__STEPPER::alg_ZERO(void) {
+
+  #line 2 "STEPPER.fbt"
+  var_OUT = var_VAL_ZERO;
+}
+
+void FORTE_signalprocessing__STEPPER::alg_UP_SLOW(void) {
+
+  #line 6 "STEPPER.fbt"
+  var_OUT = func_ADD(var_OUT, var_SLOW);
+  #line 7 "STEPPER.fbt"
+  if (func_GT(var_OUT, var_VAL_FULL)) {
+    #line 8 "STEPPER.fbt"
+    var_OUT = var_VAL_FULL;
+  }
+}
+
+void FORTE_signalprocessing__STEPPER::alg_UP_FAST(void) {
+
+  #line 13 "STEPPER.fbt"
+  var_OUT = func_ADD(var_OUT, var_FAST);
+  #line 14 "STEPPER.fbt"
+  if (func_GT(var_OUT, var_VAL_FULL)) {
+    #line 15 "STEPPER.fbt"
+    var_OUT = var_VAL_FULL;
+  }
+}
+
+void FORTE_signalprocessing__STEPPER::alg_DOWN_SLOW(void) {
+
+  #line 20 "STEPPER.fbt"
+  var_OUT = func_SUB(var_OUT, var_SLOW);
+  #line 21 "STEPPER.fbt"
+  if (func_LT(var_OUT, var_VAL_ZERO)) {
+    #line 22 "STEPPER.fbt"
+    var_OUT = var_VAL_ZERO;
+  }
+}
+
+void FORTE_signalprocessing__STEPPER::alg_DOWN_FAST(void) {
+
+  #line 27 "STEPPER.fbt"
+  var_OUT = func_SUB(var_OUT, var_FAST);
+  #line 28 "STEPPER.fbt"
+  if (func_LT(var_OUT, var_VAL_ZERO)) {
+    #line 29 "STEPPER.fbt"
+    var_OUT = var_VAL_ZERO;
+  }
+}
+
+void FORTE_signalprocessing__STEPPER::alg_FULL(void) {
+
+  #line 34 "STEPPER.fbt"
+  var_OUT = var_VAL_FULL;
+}
+
+void FORTE_signalprocessing__STEPPER::alg_LOAD(void) {
+
+  #line 38 "STEPPER.fbt"
+  var_OUT = var_PV;
+}