132 lines
4.0 KiB
C++
132 lines
4.0 KiB
C++
#include "PdecConfig.h"
|
|
#include "pdecconfigdefs.h"
|
|
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
|
|
|
PdecConfig::PdecConfig()
|
|
: localParameterHandler("conf/pdecconfig", SdCardManager::instance()) {
|
|
}
|
|
|
|
PdecConfig::~PdecConfig() {}
|
|
|
|
void PdecConfig::setMemoryBaseAddress(uint32_t* memoryBaseAddress_) {
|
|
memoryBaseAddress = memoryBaseAddress_;
|
|
}
|
|
|
|
ReturnValue_t PdecConfig::write() {
|
|
if (memoryBaseAddress == nullptr) {
|
|
sif::error << "PdecConfig::write: Memory base address not set" << std::endl;
|
|
return returnvalue::FAILED;
|
|
}
|
|
|
|
writeFrameHeaderFirstOctet();
|
|
writeFrameHeaderSecondOctet();
|
|
writeMapConfig();
|
|
return returnvalue::FAILED;
|
|
}
|
|
|
|
uint32_t PdecConfig::getImrReg() {
|
|
return static_cast<uint32_t>(enableNewFarIrq << 2) |
|
|
static_cast<uint32_t>(enableTcAbortIrq << 1) | static_cast<uint32_t>(enableTcNewIrq);
|
|
}
|
|
|
|
ReturnValue_t PdecConfig::setPositiveWindow(uint8_t pw) {
|
|
if (memoryBaseAddress == nullptr) {
|
|
sif::error << "PdecConfig::setPositiveWindow: Memory base address not set"
|
|
<< std::endl;
|
|
return returnvalue::FAILED;
|
|
}
|
|
positiveWindow = pw;
|
|
// Rewrite second config word which contains the positive window parameter
|
|
writeFrameHeaderSecondOctet();
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
ReturnValue_t PdecConfig::setNegativeWindow(uint8_t nw) {
|
|
if (memoryBaseAddress == nullptr) {
|
|
sif::error << "PdecConfig::setPositiveWindow: Memory base address not set"
|
|
<< std::endl;
|
|
return returnvalue::FAILED;
|
|
}
|
|
negativeWindow = nw;
|
|
// Rewrite second config word which contains the negative window parameter
|
|
writeFrameHeaderSecondOctet();
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
uint8_t PdecConfig::getPositiveWindow() {
|
|
return positiveWindow;
|
|
}
|
|
|
|
uint8_t PdecConfig::getNegativeWindow() {
|
|
return negativeWindow;
|
|
}
|
|
|
|
void PdecConfig::writeFrameHeaderFirstOctet() {
|
|
uint32_t word = 0;
|
|
word |= (VERSION_ID << 30);
|
|
|
|
// Setting the bypass flag and the control command flag should not have any
|
|
// implication on the operation of the PDEC IP Core
|
|
word |= (BYPASS_FLAG << 29);
|
|
word |= (CONTROL_COMMAND_FLAG << 28);
|
|
|
|
word |= (RESERVED_FIELD_A << 26);
|
|
word |= (SPACECRAFT_ID << 16);
|
|
word |= (VIRTUAL_CHANNEL << 10);
|
|
word |= (DUMMY_BITS << 8);
|
|
word |= localParameterHandler.getValue(pdecconfigdefs::paramkeys::POSITIVE_WINDOW,
|
|
pdecconfigdefs::defaultvalue::positiveWindow);
|
|
*(memoryBaseAddress + FRAME_HEADER_OFFSET) = word;
|
|
}
|
|
|
|
void PdecConfig::writeFrameHeaderSecondOctet() {
|
|
uint8_t negativeWindow = localParameterHandler.getValue(pdecconfigdefs::paramkeys::NEGATIVE_WINDOW,
|
|
pdecconfigdefs::defaultvalue::negativeWindow);
|
|
uint32_t word = 0;
|
|
word = 0;
|
|
word |= (negativeWindow << 24);
|
|
word |= (HIGH_AU_MAP_ID << 16);
|
|
word |= (ENABLE_DERANDOMIZER << 8);
|
|
*(memoryBaseAddress + FRAME_HEADER_OFFSET + 1) = word;
|
|
}
|
|
|
|
void PdecConfig::writeMapConfig() {
|
|
// Configure all MAP IDs as invalid
|
|
for (int idx = 0; idx <= MAX_MAP_ADDR; idx += 4) {
|
|
*(memoryBaseAddress + MAP_ADDR_LUT_OFFSET + idx / 4) =
|
|
NO_DESTINATION << 24 | NO_DESTINATION << 16 | NO_DESTINATION << 8 | NO_DESTINATION;
|
|
}
|
|
|
|
// All TCs with MAP ID 7 will be routed to the PM module (can then be read from memory)
|
|
uint8_t routeToPm = calcMapAddrEntry(PM_BUFFER);
|
|
*(memoryBaseAddress + MAP_ADDR_LUT_OFFSET + 1) =
|
|
(NO_DESTINATION << 24) | (NO_DESTINATION << 16) | (NO_DESTINATION << 8) | routeToPm;
|
|
|
|
// Write map id clock frequencies
|
|
for (int idx = 0; idx <= MAX_MAP_ADDR; idx += 4) {
|
|
*(memoryBaseAddress + MAP_CLK_FREQ_OFFSET + idx / 4) =
|
|
MAP_CLK_FREQ << 24 | MAP_CLK_FREQ << 16 | MAP_CLK_FREQ << 8 | MAP_CLK_FREQ;
|
|
}
|
|
}
|
|
|
|
uint8_t PdecConfig::calcMapAddrEntry(uint8_t moduleId) {
|
|
uint8_t lutEntry = 0;
|
|
uint8_t parity = getOddParity(moduleId | (1 << VALID_POSITION));
|
|
lutEntry = (parity << PARITY_POSITION) | (1 << VALID_POSITION) | moduleId;
|
|
return lutEntry;
|
|
}
|
|
|
|
uint8_t PdecConfig::getOddParity(uint8_t number) {
|
|
uint8_t parityBit = 0;
|
|
uint8_t countBits = 0;
|
|
for (unsigned int idx = 0; idx < sizeof(number) * 8; idx++) {
|
|
countBits += (number >> idx) & 0x1;
|
|
}
|
|
parityBit = ~(countBits & 0x1) & 0x1;
|
|
return parityBit;
|
|
}
|
|
|
|
|
|
|