-
Notifications
You must be signed in to change notification settings - Fork 30
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
add distance module with GEN_PULSE_DIST functionality.
- Loading branch information
1 parent
b98bb39
commit 0e4a2a6
Showing
4 changed files
with
297 additions
and
2 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -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) |
173 changes: 173 additions & 0 deletions
173
src/modules/signalprocessing/distance/GEN_PULSE_DIST_fbt.cpp
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -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; | ||
} | ||
} |
104 changes: 104 additions & 0 deletions
104
src/modules/signalprocessing/distance/GEN_PULSE_DIST_fbt.h
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -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); | ||
} | ||
}; | ||
|