add distance module with GEN_PULSE_DIST functionality.

eclipse-4diac · Oct 18, 2024 · 0e4a2a6 · 0e4a2a6
1 parent b98bb39
commit 0e4a2a6
Show file tree

Hide file tree

Showing 4 changed files with 297 additions and 2 deletions.
diff --git a/src/modules/signalprocessing/CMakeLists.txt b/src/modules/signalprocessing/CMakeLists.txt
@@ -1,5 +1,5 @@
 #*******************************************************************************
-# Copyright (c) 2023 HR Agrartechnik GmbH
+# Copyright (c) 2023, 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.
@@ -25,4 +25,5 @@ forte_add_sourcefile_hcpp(FIELDBUS_PERCENT_TO_WORD_fct)
 forte_add_sourcefile_hcpp(FIELDBUS_SIGNAL_gcf)
 forte_add_sourcefile_hcpp(SCALE_fct)
 forte_add_sourcefile_hcpp(SCALE_LIM_fct)
-forte_add_sourcefile_hcpp(RampLimitFS_fbt)
+forte_add_sourcefile_hcpp(RampLimitFS_fbt)
+forte_add_subdirectory(distance)
diff --git a/src/modules/signalprocessing/distance/CMakeLists.txt b/src/modules/signalprocessing/distance/CMakeLists.txt
@@ -0,0 +1,17 @@
+#*******************************************************************************
+# 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
+# 
+# Contributors:
+#    Franz Höpfinger - initial API and implementation and/or initial documentation
+# *******************************************************************************/
+forte_add_include_directories(${CMAKE_CURRENT_SOURCE_DIR})
+#############################################################################
+# Distance
+#############################################################################
+
+forte_add_sourcefile_hcpp(GEN_PULSE_DIST_fbt)
diff --git a/src/modules/signalprocessing/distance/GEN_PULSE_DIST_fbt.cpp b/src/modules/signalprocessing/distance/GEN_PULSE_DIST_fbt.cpp
@@ -0,0 +1,173 @@
+/*************************************************************************
+ *** 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: GEN_PULSE_DIST
+ *** Description: Distance based Impulse Generator
+ *** Version:
+ ***     1.0: 2024-10-18/Franz Höpfinger - HR Agrartechnik GmbH - initial Version
+ ***     1.1: 2024-10-18/Franz Höpfinger - HR Agrartechnik GmbH - added Offset
+ *************************************************************************/
+
+#include "GEN_PULSE_DIST_fbt.h"
+#ifdef FORTE_ENABLE_GENERATED_SOURCE_CPP
+#include "GEN_PULSE_DIST_fbt_gen.cpp"
+#endif
+
+#include "forte_bool.h"
+#include "forte_udint.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__distance__GEN_PULSE_DIST, g_nStringIdsignalprocessing__distance__GEN_PULSE_DIST)
+
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmDataInputNames[] = {g_nStringIdDIST_IN, g_nStringIdDIST_OFF, g_nStringIdDIST_HIGH, g_nStringIdDIST_LOW};
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmDataInputTypeIds[] = {g_nStringIdUDINT, g_nStringIdUDINT, g_nStringIdUDINT, g_nStringIdUDINT};
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmDataOutputNames[] = {g_nStringIdQ};
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmDataOutputTypeIds[] = {g_nStringIdBOOL};
+const TDataIOID FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmEIWith[] = {0, 1, 2, 3, scmWithListDelimiter};
+const TForteInt16 FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmEIWithIndexes[] = {0};
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmEventInputNames[] = {g_nStringIdREQ};
+const TDataIOID FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmEOWith[] = {0, scmWithListDelimiter};
+const TForteInt16 FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmEOWithIndexes[] = {0};
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmEventOutputNames[] = {g_nStringIdCNF};
+const SFBInterfaceSpec FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmFBInterfaceSpec = {
+  1, scmEventInputNames, scmEIWith, scmEIWithIndexes,
+  1, scmEventOutputNames, scmEOWith, scmEOWithIndexes,
+  4, scmDataInputNames, scmDataInputTypeIds,
+  1, scmDataOutputNames, scmDataOutputTypeIds,
+  0, nullptr,
+  0, nullptr
+};
+
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmInternalsNames[] = {g_nStringIdDIST_REMAINDER};
+const CStringDictionary::TStringId FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmInternalsTypeIds[] = {g_nStringIdUDINT};
+const SInternalVarsInformation FORTE_signalprocessing__distance__GEN_PULSE_DIST::scmInternalVars = {1, scmInternalsNames, scmInternalsTypeIds};
+
+FORTE_signalprocessing__distance__GEN_PULSE_DIST::FORTE_signalprocessing__distance__GEN_PULSE_DIST(const CStringDictionary::TStringId paInstanceNameId, forte::core::CFBContainer &paContainer) :
+    CSimpleFB(paContainer, scmFBInterfaceSpec, paInstanceNameId, &scmInternalVars),
+    var_conn_Q(var_Q),
+    conn_CNF(this, 0),
+    conn_DIST_IN(nullptr),
+    conn_DIST_OFF(nullptr),
+    conn_DIST_HIGH(nullptr),
+    conn_DIST_LOW(nullptr),
+    conn_Q(this, 0, &var_conn_Q) {
+}
+
+void FORTE_signalprocessing__distance__GEN_PULSE_DIST::setInitialValues() {
+  var_DIST_REMAINDER = 0_UDINT;
+  var_DIST_IN = 0_UDINT;
+  var_DIST_OFF = 0_UDINT;
+  var_DIST_HIGH = 0_UDINT;
+  var_DIST_LOW = 0_UDINT;
+  var_Q = 0_BOOL;
+}
+
+void FORTE_signalprocessing__distance__GEN_PULSE_DIST::executeEvent(const TEventID paEIID, CEventChainExecutionThread *const paECET) {
+  switch(paEIID) {
+    case scmEventREQID:
+      alg_REQ();
+      break;
+    default:
+      break;
+  }
+  sendOutputEvent(scmEventCNFID, paECET);
+}
+
+void FORTE_signalprocessing__distance__GEN_PULSE_DIST::readInputData(const TEventID paEIID) {
+  switch(paEIID) {
+    case scmEventREQID: {
+      readData(0, var_DIST_IN, conn_DIST_IN);
+      readData(1, var_DIST_OFF, conn_DIST_OFF);
+      readData(2, var_DIST_HIGH, conn_DIST_HIGH);
+      readData(3, var_DIST_LOW, conn_DIST_LOW);
+      break;
+    }
+    default:
+      break;
+  }
+}
+
+void FORTE_signalprocessing__distance__GEN_PULSE_DIST::writeOutputData(const TEventID paEIID) {
+  switch(paEIID) {
+    case scmEventCNFID: {
+      writeData(0, var_Q, conn_Q);
+      break;
+    }
+    default:
+      break;
+  }
+}
+
+CIEC_ANY *FORTE_signalprocessing__distance__GEN_PULSE_DIST::getDI(const size_t paIndex) {
+  switch(paIndex) {
+    case 0: return &var_DIST_IN;
+    case 1: return &var_DIST_OFF;
+    case 2: return &var_DIST_HIGH;
+    case 3: return &var_DIST_LOW;
+  }
+  return nullptr;
+}
+
+CIEC_ANY *FORTE_signalprocessing__distance__GEN_PULSE_DIST::getDO(const size_t paIndex) {
+  switch(paIndex) {
+    case 0: return &var_Q;
+  }
+  return nullptr;
+}
+
+CEventConnection *FORTE_signalprocessing__distance__GEN_PULSE_DIST::getEOConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_CNF;
+  }
+  return nullptr;
+}
+
+CDataConnection **FORTE_signalprocessing__distance__GEN_PULSE_DIST::getDIConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_DIST_IN;
+    case 1: return &conn_DIST_OFF;
+    case 2: return &conn_DIST_HIGH;
+    case 3: return &conn_DIST_LOW;
+  }
+  return nullptr;
+}
+
+CDataConnection *FORTE_signalprocessing__distance__GEN_PULSE_DIST::getDOConUnchecked(const TPortId paIndex) {
+  switch(paIndex) {
+    case 0: return &conn_Q;
+  }
+  return nullptr;
+}
+
+CIEC_ANY *FORTE_signalprocessing__distance__GEN_PULSE_DIST::getVarInternal(const size_t paIndex) {
+  switch(paIndex) {
+    case 0: return &var_DIST_REMAINDER;
+  }
+  return nullptr;
+}
+
+void FORTE_signalprocessing__distance__GEN_PULSE_DIST::alg_REQ(void) {
+
+  #line 3 "GEN_PULSE_DIST.fbt"
+  var_DIST_REMAINDER = func_MOD<CIEC_UDINT>(func_ADD<CIEC_UDINT>(var_DIST_IN, var_DIST_OFF), func_ADD<CIEC_UDINT>(var_DIST_HIGH, var_DIST_LOW));
+  #line 5 "GEN_PULSE_DIST.fbt"
+  if (func_GE(var_DIST_REMAINDER, var_DIST_HIGH)) {
+    #line 6 "GEN_PULSE_DIST.fbt"
+    var_Q = true_BOOL;
+  }
+  else {
+    #line 8 "GEN_PULSE_DIST.fbt"
+    var_Q = false_BOOL;
+  }
+}
diff --git a/src/modules/signalprocessing/distance/GEN_PULSE_DIST_fbt.h b/src/modules/signalprocessing/distance/GEN_PULSE_DIST_fbt.h
@@ -0,0 +1,104 @@
+/*************************************************************************
+ *** 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: GEN_PULSE_DIST
+ *** Description: Distance based Impulse Generator
+ *** Version:
+ ***     1.0: 2024-10-18/Franz Höpfinger - HR Agrartechnik GmbH - initial Version
+ ***     1.1: 2024-10-18/Franz Höpfinger - HR Agrartechnik GmbH - added Offset
+ *************************************************************************/
+
+#pragma once
+
+#include "simplefb.h"
+#include "forte_bool.h"
+#include "forte_udint.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__distance__GEN_PULSE_DIST final : public CSimpleFB {
+  DECLARE_FIRMWARE_FB(FORTE_signalprocessing__distance__GEN_PULSE_DIST)
+
+  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;
+
+    static const CStringDictionary::TStringId scmInternalsNames[];
+    static const CStringDictionary::TStringId scmInternalsTypeIds[];
+    static const SInternalVarsInformation scmInternalVars;
+
+    CIEC_UDINT var_DIST_REMAINDER;
+
+    CIEC_ANY *getVarInternal(size_t) override;
+
+    void alg_REQ(void);
+
+    void executeEvent(TEventID paEIID, CEventChainExecutionThread *const paECET) override;
+
+    void readInputData(TEventID paEIID) override;
+    void writeOutputData(TEventID paEIID) override;
+    void setInitialValues() override;
+
+  public:
+    FORTE_signalprocessing__distance__GEN_PULSE_DIST(CStringDictionary::TStringId paInstanceNameId, forte::core::CFBContainer &paContainer);
+
+    CIEC_UDINT var_DIST_IN;
+    CIEC_UDINT var_DIST_OFF;
+    CIEC_UDINT var_DIST_HIGH;
+    CIEC_UDINT var_DIST_LOW;
+
+    CIEC_BOOL var_Q;
+
+    CIEC_BOOL var_conn_Q;
+
+    CEventConnection conn_CNF;
+
+    CDataConnection *conn_DIST_IN;
+    CDataConnection *conn_DIST_OFF;
+    CDataConnection *conn_DIST_HIGH;
+    CDataConnection *conn_DIST_LOW;
+
+    CDataConnection conn_Q;
+
+    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_UDINT &paDIST_IN, const CIEC_UDINT &paDIST_OFF, const CIEC_UDINT &paDIST_HIGH, const CIEC_UDINT &paDIST_LOW, CIEC_BOOL &paQ) {
+      var_DIST_IN = paDIST_IN;
+      var_DIST_OFF = paDIST_OFF;
+      var_DIST_HIGH = paDIST_HIGH;
+      var_DIST_LOW = paDIST_LOW;
+      executeEvent(scmEventREQID, nullptr);
+      paQ = var_Q;
+    }
+
+    void operator()(const CIEC_UDINT &paDIST_IN, const CIEC_UDINT &paDIST_OFF, const CIEC_UDINT &paDIST_HIGH, const CIEC_UDINT &paDIST_LOW, CIEC_BOOL &paQ) {
+      evt_REQ(paDIST_IN, paDIST_OFF, paDIST_HIGH, paDIST_LOW, paQ);
+    }
+};
+