mirror of
https://github.com/nasa/fprime.git
synced 2025-12-10 17:47:10 -06:00
dfaf496263
* Initial DpDemo component, added test for decoding DPs * Updated Dp demo to include additional types, arrays, and struct records * Added struct member array to DP demo * Remove unused tlm * Cleanup after merging devel * Add deepdiff to requirements, fix formatting, update spelling * fpp v3.0.0a16 * fprime-gds v4.0.0a10 * Add 3 array record cases to DP demo * Remove comments * Remove deepdiff * Formatting, update spelling * FPP v3.0.0a18 * Spelling --------- Co-authored-by: Thomas Boyer-Chammard <49786685+thomas-bc@users.noreply.github.com>
247 lines
11 KiB
C++
247 lines
11 KiB
C++
// ======================================================================
|
|
// \title DpDemo.cpp
|
|
// \author jawest
|
|
// \brief cpp file for DpDemo component implementation class
|
|
// ======================================================================
|
|
|
|
#include "Ref/DpDemo/DpDemo.hpp"
|
|
|
|
namespace Ref {
|
|
|
|
// ----------------------------------------------------------------------
|
|
// Component construction and destruction
|
|
// ----------------------------------------------------------------------
|
|
|
|
DpDemo ::DpDemo(const char* const compName) : DpDemoComponentBase(compName) {
|
|
this->selectedColor = DpDemo_ColorEnum::RED;
|
|
this->numRecords = 0;
|
|
this->dpPriority = 0;
|
|
}
|
|
|
|
DpDemo ::~DpDemo() {}
|
|
|
|
// ----------------------------------------------------------------------
|
|
// Handler implementations for typed input ports
|
|
// ----------------------------------------------------------------------
|
|
|
|
void DpDemo ::run_handler(FwIndexType portNum, U32 context) {
|
|
// If a Data product is being generated, store records
|
|
if (this->dpInProgress) {
|
|
this->dpContainer.serializeRecord_StringRecord(Fw::String("Test string"));
|
|
this->dpContainer.serializeRecord_BooleanRecord(true);
|
|
this->dpContainer.serializeRecord_I32Record(-100);
|
|
this->dpContainer.serializeRecord_F64Record(1.25);
|
|
this->dpContainer.serializeRecord_U32ArrayRecord(DpDemo_U32Array(1, 2, 3, 4, 5));
|
|
this->dpContainer.serializeRecord_F32ArrayRecord(DpDemo_F32Array(1.1f, 2.2f, 3.3f));
|
|
this->dpContainer.serializeRecord_BooleanArrayRecord(DpDemo_BooleanArray(true, false));
|
|
// Array Records
|
|
// Array record of strings
|
|
Fw::String str0("String array element 0");
|
|
Fw::String str1("String array element 1");
|
|
Fw::String str2("String array element 2");
|
|
const Fw::StringBase* strings[3] = { &str0, &str1, &str2 };
|
|
this->dpContainer.serializeRecord_StringArrayRecord(strings, 3);
|
|
// Array record of arrays
|
|
const DpDemo_StringArray arrayArray[1] = {
|
|
DpDemo_StringArray(
|
|
Fw::String("0 - String array record element 0"),
|
|
Fw::String("0 - String array record element 1")
|
|
)
|
|
};
|
|
this->dpContainer.serializeRecord_ArrayArrayRecord(arrayArray, 1);
|
|
// Array record of structs
|
|
const DpDemo_StructWithStringMembers structArray[2] = {
|
|
DpDemo_StructWithStringMembers(
|
|
Fw::String("0 - String member"),
|
|
DpDemo_StringArray(
|
|
Fw::String("0 - String array element 0"),
|
|
Fw::String("0 - String array element 1")
|
|
)
|
|
),
|
|
DpDemo_StructWithStringMembers(
|
|
Fw::String("1 - String member"),
|
|
DpDemo_StringArray(
|
|
Fw::String("1 - String array element 0"),
|
|
Fw::String("1 - String array element 1")
|
|
)
|
|
)
|
|
};
|
|
this->dpContainer.serializeRecord_StructArrayRecord(structArray, 2);
|
|
this->dpContainer.serializeRecord_ArrayOfStringArrayRecord(
|
|
DpDemo_ArrayOfStringArray(
|
|
DpDemo_StringArray(
|
|
Fw::String("0 - String array element 0"),
|
|
Fw::String("0 - String array element 1")
|
|
),
|
|
DpDemo_StringArray(
|
|
Fw::String("1 - String array element 0"),
|
|
Fw::String("1 - String array element 1")
|
|
),
|
|
DpDemo_StringArray(
|
|
Fw::String("2 - String array element 0"),
|
|
Fw::String("2 - String array element 1")
|
|
)
|
|
)
|
|
);
|
|
this->dpContainer.serializeRecord_ArrayOfStructsRecord(
|
|
DpDemo_ArrayOfStructs(
|
|
DpDemo_StructWithStringMembers(
|
|
Fw::String("0 - String member"),
|
|
DpDemo_StringArray(
|
|
Fw::String("0 - String array element 0"),
|
|
Fw::String("0 - String array element 1")
|
|
)
|
|
),
|
|
DpDemo_StructWithStringMembers(
|
|
Fw::String("1 - String member"),
|
|
DpDemo_StringArray(
|
|
Fw::String("1 - String array element 0"),
|
|
Fw::String("1 - String array element 1")
|
|
)
|
|
),
|
|
DpDemo_StructWithStringMembers(
|
|
Fw::String("2 - String member"),
|
|
DpDemo_StringArray(
|
|
Fw::String("2 - String array element 0"),
|
|
Fw::String("2 - String array element 1")
|
|
)
|
|
)
|
|
)
|
|
);
|
|
this->dpContainer.serializeRecord_EnumArrayRecord(DpDemo_EnumArray(DpDemo_ColorEnum::RED, DpDemo_ColorEnum::GREEN, DpDemo_ColorEnum::BLUE));
|
|
this->dpContainer.serializeRecord_StructWithEverythingRecord(DpDemo_StructWithEverything(
|
|
-1,
|
|
2.5,
|
|
Fw::String("String Member"),
|
|
false,
|
|
this->selectedColor,
|
|
{
|
|
DpDemo_U32Array(1, 2, 3, 4, 5),
|
|
DpDemo_U32Array(6, 7, 8, 9, 10)
|
|
},
|
|
DpDemo_F32Array(4.4f, 5.5f, 6.6f),
|
|
DpDemo_U32Array(6, 7, 8, 9, 10),
|
|
DpDemo_EnumArray(DpDemo_ColorEnum::RED, DpDemo_ColorEnum::GREEN, DpDemo_ColorEnum::BLUE),
|
|
DpDemo_StringArray(
|
|
Fw::String("String array element 0"),
|
|
Fw::String("String array element 1")
|
|
),
|
|
DpDemo_BooleanArray(true, false),
|
|
DpDemo_StructWithStringMembers(
|
|
Fw::String("String member"),
|
|
DpDemo_StringArray(
|
|
Fw::String("String array element 0"),
|
|
Fw::String("String array element 1")
|
|
)
|
|
),
|
|
DpDemo_ArrayOfStringArray(
|
|
DpDemo_StringArray(
|
|
Fw::String("0 - String array element 0"),
|
|
Fw::String("0 - String array element 1")
|
|
),
|
|
DpDemo_StringArray(
|
|
Fw::String("1 - String array element 0"),
|
|
Fw::String("1 - String array element 1")
|
|
),
|
|
DpDemo_StringArray(
|
|
Fw::String("2 - String array element 0"),
|
|
Fw::String("2 - String array element 1")
|
|
)
|
|
)
|
|
));
|
|
this->log_ACTIVITY_LO_DpComplete(this->numRecords);
|
|
this->cleanupAndSendDp();
|
|
}
|
|
}
|
|
|
|
// ----------------------------------------------------------------------
|
|
// Handler implementations for commands
|
|
// ----------------------------------------------------------------------
|
|
|
|
void DpDemo ::SelectColor_cmdHandler(FwOpcodeType opCode, U32 cmdSeq, Ref::DpDemo_ColorEnum color) {
|
|
this->selectedColor = color;
|
|
log_ACTIVITY_HI_ColorSelected(color);
|
|
this->cmdResponse_out(opCode, cmdSeq, Fw::CmdResponse::OK);
|
|
}
|
|
|
|
void DpDemo ::Dp_cmdHandler(FwOpcodeType opCode, U32 cmdSeq, DpDemo_DpReqType reqType, U32 priority) {
|
|
|
|
// make sure DPs are available
|
|
if (!this->isConnected_productGetOut_OutputPort(0) || !this->isConnected_productRequestOut_OutputPort(0)) {
|
|
this->log_WARNING_HI_DpsNotConnected();
|
|
this->cmdResponse_out(opCode, cmdSeq, Fw::CmdResponse::EXECUTION_ERROR);
|
|
return;
|
|
}
|
|
|
|
this->numRecords = 15; // 15 records in current demo
|
|
FwSizeType dpSize = DpDemo_StringAlias::SERIALIZED_SIZE +
|
|
sizeof(DpDemo_BoolAlias) +
|
|
sizeof(DpDemo_I32Alias) +
|
|
sizeof(DpDemo_F64Alias) +
|
|
DpDemo_U32Array::SERIALIZED_SIZE +
|
|
DpDemo_F32Array::SERIALIZED_SIZE +
|
|
DpDemo_BooleanArray::SERIALIZED_SIZE +
|
|
DpDemo_EnumArray::SERIALIZED_SIZE +
|
|
DpDemo_StringArray::SERIALIZED_SIZE +
|
|
DpDemo_StructWithEverything::SERIALIZED_SIZE +
|
|
DpDemo_StructWithStringMembers::SERIALIZED_SIZE +
|
|
(DpDemo_StringArray::SERIALIZED_SIZE * 3) +
|
|
(DpDemo_StringArray::SERIALIZED_SIZE * 1) +
|
|
(DpDemo_StructWithStringMembers::SERIALIZED_SIZE * 2) +
|
|
DpDemo_ArrayOfStringArray::SERIALIZED_SIZE +
|
|
(numRecords * sizeof(FwDpIdType));
|
|
|
|
this->dpPriority = static_cast<FwDpPriorityType>(priority);
|
|
this->log_ACTIVITY_LO_DpMemRequested(dpSize);
|
|
if(reqType == DpDemo_DpReqType::IMMEDIATE) {
|
|
Fw::Success stat = this->dpGet_DpDemoContainer(dpSize, this->dpContainer);
|
|
// make sure we got the memory we wanted
|
|
if (Fw::Success::FAILURE == stat) {
|
|
this->log_WARNING_HI_DpMemoryFail();
|
|
this->cmdResponse_out(opCode, cmdSeq, Fw::CmdResponse::EXECUTION_ERROR);
|
|
} else {
|
|
this->dpInProgress = true;
|
|
this->log_ACTIVITY_LO_DpStarted(numRecords);
|
|
this->log_ACTIVITY_LO_DpMemReceived(this->dpContainer.getBuffer().getSize());
|
|
// override priority with requested priority
|
|
this->dpContainer.setPriority(priority);
|
|
this->cmdResponse_out(opCode, cmdSeq, Fw::CmdResponse::OK);
|
|
}
|
|
}
|
|
else if (reqType == DpDemo_DpReqType::ASYNC) {
|
|
this->dpRequest_DpDemoContainer(dpSize);
|
|
}
|
|
else {
|
|
// should never get here
|
|
FW_ASSERT(0, reqType.e);
|
|
}
|
|
}
|
|
|
|
// ----------------------------------------------------------------------
|
|
// Handler implementations for data products
|
|
// ----------------------------------------------------------------------
|
|
|
|
void DpDemo ::dpRecv_DpDemoContainer_handler(DpContainer& container, Fw::Success::T status) {
|
|
// Make sure we got the buffer we wanted or quit
|
|
if (Fw::Success::SUCCESS == status) {
|
|
this->dpContainer = container;
|
|
this->dpInProgress = true;
|
|
// set previously requested priority
|
|
this->dpContainer.setPriority(this->dpPriority);
|
|
this->log_ACTIVITY_LO_DpStarted(this->numRecords);
|
|
} else {
|
|
this->log_WARNING_HI_DpMemoryFail();
|
|
// cleanup
|
|
this->dpInProgress = false;
|
|
this->numRecords = 0;
|
|
}
|
|
}
|
|
|
|
void DpDemo ::cleanupAndSendDp() {
|
|
this->dpSend(this->dpContainer);
|
|
this->dpInProgress = false;
|
|
this->numRecords = 0;
|
|
}
|
|
|
|
} // namespace Ref
|