-
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 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.
- Loading branch information
1 parent
2ed9dc5
commit 981128a
Showing
3 changed files
with
252 additions
and
1 deletion.
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,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; | ||
} |
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,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); | ||
|