310 lines
12 KiB
Plaintext
310 lines
12 KiB
Plaintext
/**
|
|
* @file JAConditionalSignalUpdateGAM.cpp
|
|
* @brief Source file for class JAConditionalSignalUpdateGAM
|
|
* @date Jan, 2019
|
|
* @author rhari
|
|
*
|
|
* @copyright Copyright 2015 F4E | European Joint Undertaking for ITER and
|
|
* the Development of Fusion Energy ('Fusion for Energy').
|
|
* Licensed under the EUPL, Version 1.1 or - as soon they will be approved
|
|
* by the European Commission - subsequent versions of the EUPL (the "Licence")
|
|
* You may not use this work except in compliance with the Licence.
|
|
* You may obtain a copy of the Licence at: http://ec.europa.eu/idabc/eupl
|
|
*
|
|
* @warning Unless required by applicable law or agreed to in writing,
|
|
* software distributed under the Licence is distributed on an "AS IS"
|
|
* basis, WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express
|
|
* or implied. See the Licence permissions and limitations under the Licence.
|
|
|
|
* @details This source file contains the definition of all the methods for
|
|
* the class JAConditionalSignalUpdateGAM (public, protected, and private). Be aware that some
|
|
* methods, such as those inline could be defined on the header file, instead.
|
|
*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
/* Standard header includes */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
/* Project header includes */
|
|
/*---------------------------------------------------------------------------*/
|
|
#include "JAConditionalSignalUpdateGAM.h"
|
|
#include "AdvancedErrorManagement.h"
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
/* Static definitions */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
/* Method definitions */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
JAConditionalSignalUpdateGAM::JAConditionalSignalUpdateGAM() {
|
|
inputSignals = NULL_PTR(void **);
|
|
inputSignalTypes = NULL_PTR(MARTe::TypeDescriptor *);
|
|
values = NULL_PTR(MARTe::uint32 *);
|
|
valuesCount = 0u;
|
|
outputSignals = NULL_PTR(MARTe::uint32 **);
|
|
defaultValues = NULL_PTR(MARTe::uint32 **);
|
|
needsReset = false;
|
|
expectedValues = NULL_PTR(MARTe::uint32 *);
|
|
expectedValuesCount = 0u;
|
|
operation = And;
|
|
comparators = NULL_PTR(ComparisonMode *);
|
|
}
|
|
|
|
JAConditionalSignalUpdateGAM::~JAConditionalSignalUpdateGAM() {
|
|
if (outputSignals != NULL_PTR(MARTe::uint32 **)) {
|
|
delete[] outputSignals;
|
|
}
|
|
if (inputSignals != NULL_PTR(void **)) {
|
|
delete[] inputSignals;
|
|
}
|
|
if (inputSignalTypes != NULL_PTR(MARTe::TypeDescriptor *)) {
|
|
delete[] inputSignalTypes;
|
|
}
|
|
if (values != NULL_PTR(MARTe::uint32 *)) {
|
|
delete[] values;
|
|
}
|
|
if (comparators != NULL_PTR(ComparisonMode *)) {
|
|
delete[] comparators;
|
|
}
|
|
if (defaultValues != NULL_PTR(MARTe::uint32 **)) {
|
|
delete[] defaultValues;
|
|
}
|
|
}
|
|
|
|
bool JAConditionalSignalUpdateGAM::Initialise(MARTe::StructuredDataI & data) {
|
|
using namespace MARTe;
|
|
bool ok = GAM::Initialise(data);
|
|
if (ok) {
|
|
// Read expected values.
|
|
AnyType valuesArray = data.GetType("ExpectedValues");
|
|
|
|
if (valuesArray.GetDataPointer() != NULL) {
|
|
expectedValuesCount = valuesArray.GetNumberOfElements(0u);
|
|
|
|
expectedValues = new uint32[expectedValuesCount];
|
|
|
|
Vector<uint32> valuesVector(expectedValues, expectedValuesCount);
|
|
ok = (data.Read("ExpectedValues", valuesVector));
|
|
}
|
|
}
|
|
if (ok) {
|
|
// Read comparators.
|
|
AnyType comparatorsArray = data.GetType("Comparators");
|
|
if (comparatorsArray.GetDataPointer() != NULL) {
|
|
uint32 count;
|
|
if (ok) {
|
|
count = comparatorsArray.GetNumberOfElements(0u);
|
|
ok = count == expectedValuesCount;
|
|
}
|
|
if (ok) {
|
|
comparators = new ComparisonMode[count];
|
|
StreamString* comp = new StreamString[count];
|
|
Vector<StreamString> compVector(comp, count);
|
|
|
|
ok = (data.Read("Comparators", compVector));
|
|
|
|
if (ok) {
|
|
for (uint32 i = 0; i < count; ++i) {
|
|
if (comp[i] == "EQUALS") {
|
|
comparators[i] = Equals;
|
|
} else if (comp[i] == "NOT") {
|
|
comparators[i] = Not;
|
|
} else if (comp[i] == "GREATER") {
|
|
comparators[i] = Greater;
|
|
} else if (comp[i] == "EQUALS_OR_GREATER") {
|
|
comparators[i] = EqualsOrGreater;
|
|
} else if (comp[i] == "LESS") {
|
|
comparators[i] = Less;
|
|
} else if (comp[i] == "EQUALS_OR_LESS") {
|
|
comparators[i] = EqualsOrLess;
|
|
} else {
|
|
ok = false;
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "Comparator %s is not defined.", comp[i].Buffer());
|
|
}
|
|
}
|
|
}
|
|
delete[] comp;
|
|
} else {
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "Expected values and operators shall have the same "
|
|
"number of elements.");
|
|
}
|
|
} else {
|
|
// Create default comparators (equals) when they aren't provided in the configuration.
|
|
comparators = new ComparisonMode[expectedValuesCount];
|
|
for (uint32 i = 0; i < expectedValuesCount; ++i) {
|
|
comparators[i] = Equals;
|
|
}
|
|
}
|
|
}
|
|
if (ok) {
|
|
MARTe::StreamString operationStr;
|
|
if (data.Read("Operation", operationStr)) {
|
|
if (operationStr == "AND") {
|
|
operation = And;
|
|
}
|
|
else if (operationStr == "OR") {
|
|
operation = Or;
|
|
}
|
|
else if (operationStr == "NOR") {
|
|
operation = Nor;
|
|
}
|
|
else if (operationStr == "XOR") {
|
|
operation = Xor;
|
|
}
|
|
else {
|
|
ok = false;
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "Operation %s is not defined", operationStr.Buffer());
|
|
}
|
|
}
|
|
}
|
|
if (ok) {
|
|
// Read output signal values to be set.
|
|
AnyType valuesArray = data.GetType("Values");
|
|
ok = (valuesArray.GetDataPointer() != NULL);
|
|
|
|
if (ok) {
|
|
valuesCount = valuesArray.GetNumberOfElements(0u);
|
|
ok = valuesCount > 0u;
|
|
}
|
|
if (ok) {
|
|
values = new uint32[valuesCount];
|
|
|
|
Vector<uint32> valuesVector(values, valuesCount);
|
|
ok = (data.Read("Values", valuesVector));
|
|
}
|
|
if (!ok) {
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "Values shall be defined.");
|
|
}
|
|
}
|
|
return ok;
|
|
}
|
|
|
|
bool JAConditionalSignalUpdateGAM::Setup() {
|
|
using namespace MARTe;
|
|
bool ok = numberOfInputSignals == (expectedValuesCount + numberOfOutputSignals);
|
|
if (ok) {
|
|
inputSignals = new void*[expectedValuesCount];
|
|
defaultValues = new uint32*[numberOfOutputSignals];
|
|
uint32 i;
|
|
for (i = 0u; i < expectedValuesCount; i++) {
|
|
inputSignals[i] = GetInputSignalMemory(i);
|
|
}
|
|
for (; i < numberOfInputSignals; i++) {
|
|
defaultValues[i - expectedValuesCount] = reinterpret_cast<uint32 *>(GetInputSignalMemory(i));
|
|
}
|
|
} else {
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "Number of input signals shall be equal to number "
|
|
"of expected values plus number of output signals.");
|
|
}
|
|
if (ok) {
|
|
inputSignalTypes = new TypeDescriptor[expectedValuesCount];
|
|
uint32 i;
|
|
for (i = 0u; (i < expectedValuesCount) && (ok); i++) {
|
|
inputSignalTypes[i] = GetSignalType(InputSignals, i);
|
|
ok = ((inputSignalTypes[i] == UnsignedInteger32Bit) || (inputSignalTypes[i] == UnsignedInteger16Bit));
|
|
if (!ok) {
|
|
StreamString signalName;
|
|
(void) GetSignalName(InputSignals, i, signalName);
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "Signal %s shall be defined as uint32 or uint16", signalName.Buffer());
|
|
}
|
|
}
|
|
}
|
|
if (ok) {
|
|
ok = numberOfOutputSignals == valuesCount;
|
|
if (ok) {
|
|
ok = numberOfOutputSignals > 0u;
|
|
if (ok) {
|
|
outputSignals = new uint32*[numberOfOutputSignals];
|
|
uint32 i;
|
|
for (i = 0u; i < numberOfOutputSignals; i++) {
|
|
outputSignals[i] = reinterpret_cast<uint32 *>(GetOutputSignalMemory(i));
|
|
}
|
|
}
|
|
else {
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "At least one output signal shall be defined");
|
|
}
|
|
}
|
|
else {
|
|
REPORT_ERROR(ErrorManagement::ParametersError, "Number of output signals shall be the same as "
|
|
"number of provided values.");
|
|
}
|
|
}
|
|
|
|
return ok;
|
|
}
|
|
|
|
bool JAConditionalSignalUpdateGAM::PrepareNextState(const MARTe::char8 * const currentStateName, const MARTe::char8 * const nextStateName) {
|
|
needsReset = false;
|
|
return true;
|
|
}
|
|
|
|
bool JAConditionalSignalUpdateGAM::Execute() {
|
|
if (!needsReset) {
|
|
bool eventDetected = expectedValuesCount == 0;
|
|
if (!eventDetected) {
|
|
if (operation == Or) {
|
|
MARTe::uint32 j;
|
|
for (j = 0; (j < expectedValuesCount) && (!eventDetected); j++) {
|
|
eventDetected = Compare(j);
|
|
}
|
|
}
|
|
else if (operation == Nor) {
|
|
MARTe::uint32 j;
|
|
for (j = 0; (j < expectedValuesCount) && (!eventDetected); j++) {
|
|
eventDetected = Compare(j);
|
|
}
|
|
eventDetected = !eventDetected;
|
|
}
|
|
else if (operation == And) {
|
|
MARTe::uint32 j;
|
|
eventDetected = Compare(0);
|
|
for (j = 1; (j < expectedValuesCount); j++) {
|
|
eventDetected &= Compare(j);
|
|
}
|
|
}
|
|
else if (operation == Xor) {
|
|
MARTe::uint32 j;
|
|
MARTe::uint32 eventDetectedUint32;
|
|
if (inputSignalTypes[0] == MARTe::UnsignedInteger32Bit) {
|
|
eventDetectedUint32 = *static_cast<MARTe::uint32 *>(inputSignals[0]);
|
|
}
|
|
else {
|
|
eventDetectedUint32 = *static_cast<MARTe::uint16 *>(inputSignals[0]);
|
|
}
|
|
for (j = 1; (j < expectedValuesCount); j++) {
|
|
eventDetectedUint32 ^= Compare(j);
|
|
}
|
|
eventDetected = (eventDetectedUint32 == 1u);
|
|
}
|
|
}
|
|
if (eventDetected) {
|
|
needsReset = true;
|
|
MARTe::uint32 i;
|
|
for (i = 0u; i < numberOfOutputSignals; ++i) {
|
|
*outputSignals[i] = values[i];
|
|
MARTe::StreamString signalName;
|
|
(void) GetSignalName(MARTe::OutputSignals, i, signalName);
|
|
}
|
|
}
|
|
else {
|
|
MARTe::uint32 i;
|
|
for (i = 0u; i < numberOfOutputSignals; ++i) {
|
|
*outputSignals[i] = *defaultValues[i];
|
|
}
|
|
}
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool JAConditionalSignalUpdateGAM::Compare(MARTe::uint32 index) {
|
|
if (inputSignalTypes[index] == MARTe::UnsignedInteger32Bit) {
|
|
return Compare<MARTe::uint32>(index);
|
|
}
|
|
return Compare<MARTe::uint16>(index);
|
|
}
|
|
|
|
CLASS_REGISTER(JAConditionalSignalUpdateGAM, "1.0")
|