65 lines
2.4 KiB
C++
65 lines
2.4 KiB
C++
#include "fsfw/parameters/ParameterMessage.h"
|
|
|
|
#include "fsfw/objectmanager/ObjectManager.h"
|
|
|
|
ParameterId_t ParameterMessage::getParameterId(const CommandMessage* message) {
|
|
return message->getParameter();
|
|
}
|
|
|
|
store_address_t ParameterMessage::getStoreId(const CommandMessage* message) {
|
|
store_address_t address;
|
|
address.raw = message->getParameter2();
|
|
return address;
|
|
}
|
|
|
|
void ParameterMessage::setParameterDumpCommand(CommandMessage* message, ParameterId_t id) {
|
|
message->setCommand(CMD_PARAMETER_DUMP);
|
|
message->setParameter(id);
|
|
}
|
|
|
|
void ParameterMessage::setParameterDumpReply(CommandMessage* message, ParameterId_t id,
|
|
store_address_t storageID) {
|
|
message->setCommand(REPLY_PARAMETER_DUMP);
|
|
message->setParameter(id);
|
|
message->setParameter2(storageID.raw);
|
|
}
|
|
|
|
void ParameterMessage::setParameterLoadCommand(CommandMessage* message, ParameterId_t id,
|
|
store_address_t storeId, uint8_t ptc, uint8_t pfc,
|
|
uint8_t rows = 1, uint8_t columns = 1) {
|
|
message->setCommand(CMD_PARAMETER_LOAD);
|
|
message->setParameter(id);
|
|
message->setParameter2(storeId.raw);
|
|
uint32_t packedParameterSettings = (ptc << 24) | (pfc << 16) | (rows << 8) | columns;
|
|
message->setParameter3(packedParameterSettings);
|
|
}
|
|
|
|
store_address_t ParameterMessage::getParameterLoadCommand(const CommandMessage* message,
|
|
ParameterId_t* parameterId, uint8_t* ptc,
|
|
uint8_t* pfc, uint8_t* rows,
|
|
uint8_t* columns) {
|
|
*parameterId = message->getParameter();
|
|
uint32_t packedParamSettings = message->getParameter3();
|
|
*ptc = packedParamSettings >> 24 & 0xff;
|
|
*pfc = packedParamSettings >> 16 & 0xff;
|
|
*rows = packedParamSettings >> 8 & 0xff;
|
|
*columns = packedParamSettings & 0xff;
|
|
return static_cast<store_address_t>(message->getParameter2());
|
|
}
|
|
|
|
void ParameterMessage::clear(CommandMessage* message) {
|
|
switch (message->getCommand()) {
|
|
case CMD_PARAMETER_LOAD:
|
|
case REPLY_PARAMETER_DUMP: {
|
|
StorageManagerIF* ipcStore =
|
|
ObjectManager::instance()->get<StorageManagerIF>(objects::IPC_STORE);
|
|
if (ipcStore != NULL) {
|
|
ipcStore->deleteData(getStoreId(message));
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
break;
|
|
}
|
|
}
|