martino/ec-gn-ja-pcf
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Fixed types and feedback

Browse Source
This commit is contained in:
Martino Ferrari
2026-02-06 18:15:42 +01:00
parent 872baa1dc2
commit cdd700bf4e
2 changed files with 235 additions and 224 deletions
Download Patch File Download Diff File Expand all files Collapse all files

143
EC-GN-JA-PCF-IN/src/main/c++/GAMs/JARampupGAM/JARampupGAM.cpp
View File

@@ -41,11 +41,10 @@
/*---------------------------------------------------------------------------*/
JARampupGAM::JARampupGAM() : GAM() {
current_setpoint = NULL_PTR(MARTe::float32 *);
target_value = NULL_PTR(MARTe::float32 *);
rampup_time = NULL_PTR(MARTe::float32 *);
start = NULL_PTR(MARTe::uint32 *);
standby = NULL_PTR(MARTe::uint32 *);
standby = NULL_PTR(MARTe::uint8 *);
isAuto = NULL_PTR(MARTe::uint32 *);
FHPS_PrePro = NULL_PTR(MARTe::float32 *);
@@ -59,25 +58,25 @@ JARampupGAM::JARampupGAM() : GAM() {
inWaitStandby = false;
}
JARampupGAM::~JARampupGAM() {
}
JARampupGAM::~JARampupGAM() {}
bool JARampupGAM::Initialise(MARTe::StructuredDataI & data) {
bool JARampupGAM::Initialise(MARTe::StructuredDataI &data) {
using namespace MARTe;
return GAM::Initialise(data);
}
bool JARampupGAM::Setup() {
using namespace MARTe;
bool ok = (numberOfInputSignals == 7u);
bool ok = (numberOfInputSignals == 6u);
if (ok) {
ok = (numberOfOutputSignals == 2u);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Two output signals shall be defined.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Two output signals shall be defined.");
}
}
else {
REPORT_ERROR(ErrorManagement::ParametersError, "Six input signals shall be defined.");
} else {
REPORT_ERROR(ErrorManagement::ParametersError,
"Six input signals shall be defined.");
}
uint32 currentspvIndex;
uint32 targetvIndex;
@@ -91,13 +90,14 @@ bool JARampupGAM::Setup() {
StreamString signalName = "Currspv";
ok = GetSignalIndex(InputSignals, currentspvIndex, signalName.Buffer());
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Currspv input signal shall be defined.");
}
else {
REPORT_ERROR(ErrorManagement::ParametersError,
"Currspv input signal shall be defined.");
} else {
TypeDescriptor inputType = GetSignalType(InputSignals, currentspvIndex);
ok = (inputType == Float32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Signal Currspv shall be defined as float32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Signal Currspv shall be defined as float32.");
}
}
}
@@ -105,13 +105,14 @@ bool JARampupGAM::Setup() {
StreamString signalName = "Targetv";
ok = GetSignalIndex(InputSignals, targetvIndex, signalName.Buffer());
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Targetv input signal shall be defined.");
}
else {
REPORT_ERROR(ErrorManagement::ParametersError,
"Targetv input signal shall be defined.");
} else {
TypeDescriptor inputType = GetSignalType(InputSignals, targetvIndex);
ok = (inputType == Float32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Signal Targetv shall be defined as float32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Signal Targetv shall be defined as float32.");
}
}
}
@@ -119,13 +120,14 @@ bool JARampupGAM::Setup() {
StreamString signalName = "Time";
ok = GetSignalIndex(InputSignals, timeIndex, signalName.Buffer());
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Time input signal shall be defined.");
}
else {
REPORT_ERROR(ErrorManagement::ParametersError,
"Time input signal shall be defined.");
} else {
TypeDescriptor inputType = GetSignalType(InputSignals, timeIndex);
ok = (inputType == Float32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Signal Time shall be defined as float32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Signal Time shall be defined as float32.");
}
}
}
@@ -133,13 +135,14 @@ bool JARampupGAM::Setup() {
StreamString signalName = "Start";
ok = GetSignalIndex(InputSignals, startIndex, signalName.Buffer());
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Start input signal shall be defined.");
}
else {
REPORT_ERROR(ErrorManagement::ParametersError,
"Start input signal shall be defined.");
} else {
TypeDescriptor inputType = GetSignalType(InputSignals, startIndex);
ok = (inputType == UnsignedInteger32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Start shall be defined as uint32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Start shall be defined as uint32.");
}
}
}
@@ -147,13 +150,14 @@ bool JARampupGAM::Setup() {
StreamString signalName = "PLC_STANDBY";
ok = GetSignalIndex(InputSignals, standbyIndex, signalName.Buffer());
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "PLC_STANDBY input signal shall be defined.");
}
else {
REPORT_ERROR(ErrorManagement::ParametersError,
"PLC_STANDBY input signal shall be defined.");
} else {
TypeDescriptor inputType = GetSignalType(InputSignals, standbyIndex);
ok = (inputType == UnsignedInteger32Bit);
ok = (inputType == UnsignedInteger8Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "PLC_STANDBY shall be defined as uint32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"PLC_STANDBY shall be defined as uint8.");
}
}
}
@@ -161,13 +165,14 @@ bool JARampupGAM::Setup() {
StreamString signalName = "MANUAL_AUTO";
ok = GetSignalIndex(InputSignals, isAutoIndex, signalName.Buffer());
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "MANUAL_AUTO input signal shall be defined.");
}
else {
REPORT_ERROR(ErrorManagement::ParametersError,
"MANUAL_AUTO input signal shall be defined.");
} else {
TypeDescriptor inputType = GetSignalType(InputSignals, isAutoIndex);
ok = (inputType == UnsignedInteger32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "MANUAL_AUTO shall be defined as uint32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"MANUAL_AUTO shall be defined as uint32.");
}
}
}
@@ -175,13 +180,14 @@ bool JARampupGAM::Setup() {
StreamString signalName = "FHPS_PrePro";
ok = GetSignalIndex(InputSignals, fhpsPreProIndex, signalName.Buffer());
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "FHPS_PrePro input signal shall be defined.");
}
else {
REPORT_ERROR(ErrorManagement::ParametersError,
"FHPS_PrePro input signal shall be defined.");
} else {
TypeDescriptor inputType = GetSignalType(InputSignals, fhpsPreProIndex);
ok = (inputType == Float32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Signal FHPS_PrePro shall be defined as float32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Signal FHPS_PrePro shall be defined as float32.");
}
}
}
@@ -190,25 +196,28 @@ bool JARampupGAM::Setup() {
TypeDescriptor inputType = GetSignalType(OutputSignals, 0);
ok = (inputType == Float32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Signal Output shall be defined as float32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Signal Output shall be defined as float32.");
}
}
if (ok) {
TypeDescriptor inputType = GetSignalType(OutputSignals, 1);
ok = (inputType == UnsignedInteger32Bit);
if (!ok) {
REPORT_ERROR(ErrorManagement::ParametersError, "Signal state shall be defined as float32.");
REPORT_ERROR(ErrorManagement::ParametersError,
"Signal state shall be defined as float32.");
}
}
if (ok) {
current_setpoint = reinterpret_cast<float32 *>(GetInputSignalMemory(currentspvIndex));
target_value = reinterpret_cast<float32 *>(GetInputSignalMemory(targetvIndex));
target_value =
reinterpret_cast<float32 *>(GetInputSignalMemory(targetvIndex));
rampup_time = reinterpret_cast<float32 *>(GetInputSignalMemory(timeIndex));
start = reinterpret_cast<uint32 *>(GetInputSignalMemory(startIndex));
standby = reinterpret_cast<uint32 *>(GetInputSignalMemory(standbyIndex));
standby = reinterpret_cast<uint8 *>(GetInputSignalMemory(standbyIndex));
isAuto = reinterpret_cast<uint32 *>(GetInputSignalMemory(isAutoIndex));
FHPS_PrePro = reinterpret_cast<float32 *>(GetInputSignalMemory(fhpsPreProIndex));
FHPS_PrePro =
reinterpret_cast<float32 *>(GetInputSignalMemory(fhpsPreProIndex));
output = reinterpret_cast<float32 *>(GetOutputSignalMemory(0));
state = reinterpret_cast<uint32 *>(GetOutputSignalMemory(1));
@@ -216,14 +225,17 @@ bool JARampupGAM::Setup() {
return ok;
}
bool JARampupGAM::PrepareNextState(const MARTe::char8 * const currentStateName, const MARTe::char8 * const nextStateName){
if(strcmp(nextStateName, "WaitHVON_PREP")==0 || strcmp(nextStateName, "WaitHVON_SDN_PREP")==0 ||
strcmp(nextStateName, "WaitHVON")==0 || strcmp(nextStateName, "WaitHVON_SDN")==0){
bool JARampupGAM::PrepareNextState(const MARTe::char8 *const currentStateName,
const MARTe::char8 *const nextStateName) {
if (strcmp(nextStateName, "WaitHVON_PREP") == 0 ||
strcmp(nextStateName, "WaitHVON_SDN_PREP") == 0 ||
strcmp(nextStateName, "WaitHVON") == 0 ||
strcmp(nextStateName, "WaitHVON_SDN") == 0) {
inWaitHVON = true;
inWaitStandby = false;
} else{
} else {
inWaitHVON = false;
if(strcmp(nextStateName,"WaitStandby")==0 ){
if (strcmp(nextStateName, "WaitStandby") == 0) {
inWaitStandby = true;
} else {
inWaitStandby = false;
@@ -234,11 +246,12 @@ bool JARampupGAM::PrepareNextState(const MARTe::char8 * const currentStateName,
bool JARampupGAM::Execute() {
using namespace MARTe;
if(!inWaitHVON){
float32 current_setpoint = *output;
if (!inWaitHVON) {
if (*target_value <= 0.0f || *standby == 0u) {
*output = 0.0f;
rampup_rate = 0.0f;
if(*target_value <= 0.0f){
if (*target_value <= 0.0f) {
*state = 3u;
} else {
*state = 0u;
@@ -246,32 +259,32 @@ bool JARampupGAM::Execute() {
return true;
}
if(*start == 1u && *isAuto==0u){ //isAuto = 1.Manual, 0.auto-rampup.
if (*start == 1u && *isAuto == 0u) { // isAuto = 1.Manual, 0.auto-rampup.
inRampup = true;
resetFlag = true;
*output = 0.0f; //Enable if it should start always zero.
*output = 0.0f; // Enable if it should start always zero.
}
// Calcrate new rampup rate.
if(*rampup_time != 0 && resetFlag == true){
rampup_rate = (*target_value - *current_setpoint) / *rampup_time/1000.0f; // Volt/msec
if (*rampup_time != 0 && resetFlag == true) {
rampup_rate = (*target_value - current_setpoint) / *rampup_time /
1000.0f; // Volt/msec
resetFlag = false;
}
// Update Parameter
if(*standby == 1u ){
if(*isAuto == 1u){
if (inWaitStandby){
if (*standby == 1u) {
if (*isAuto == 1u) {
if (inWaitStandby) {
*output = *target_value;
} else{
} else {
*output = *FHPS_PrePro;
}
//*output = *target_value;
*state = 0u;
return true;
}
else if (inRampup){
if (*output + rampup_rate < *target_value && *rampup_time != 0){
} else if (inRampup) {
if (*output + rampup_rate < *target_value && *rampup_time != 0) {
*output = *output + rampup_rate;
*state = 1u;
} else {
@@ -283,9 +296,9 @@ bool JARampupGAM::Execute() {
}
return true;
} else {
if(*isAuto == 0){
if (*isAuto == 0) {
*output = *FHPS_PrePro;
} else{
} else {
*output = *target_value;
}
return true;

4
EC-GN-JA-PCF-IN/src/main/c++/GAMs/JARampupGAM/JARampupGAM.h
View File

@@ -97,8 +97,6 @@ public:
const MARTe::char8 * const nextStateName);
private:
// Input signal containing current current_setpoint
MARTe::float32 *current_setpoint;
// Input signal containing the frequency of the waveform.
MARTe::float32 *target_value;
@@ -110,7 +108,7 @@ private:
MARTe::uint32 *start;
// Input signal PLC_STANDBY
MARTe::uint32 *standby;
MARTe::uint8 *standby;
// MANUAL AUTO button
MARTe::uint32 *isAuto;