local parameter handler wip

linux/ipcore/PdecConfig.cpp

@@ -2,41 +2,126 @@
 
 #include "fsfw/serviceinterface/ServiceInterface.h"
 
-PdecConfig::PdecConfig() { initialize(); }
+PdecConfig::PdecConfig()
+    : localParameterHandler("conf/pdecconfig", SdCardManager::instance()) {
+}
 
 PdecConfig::~PdecConfig() {}
 
-void PdecConfig::initialize() {
-  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 |= POSITIVE_WINDOW;
-  configWords[0] = word;
-  word = 0;
-  word |= (NEGATIVE_WINDOW << 24);
-  word |= (HIGH_AU_MAP_ID << 16);
-  word |= (ENABLE_DERANDOMIZER << 8);
-  configWords[1] = word;
+void PdecConfig::setMemoryBaseAddress(uint32_t* memoryBaseAddress_) {
+	memoryBaseAddress = memoryBaseAddress_;
 }
 
-uint32_t PdecConfig::getConfigWord(uint8_t wordNo) {
-  if (wordNo >= CONFIG_WORDS_NUM) {
-    sif::error << "PdecConfig::getConfigWord: Invalid word number" << std::endl;
-    return 0;
-  }
-  return configWords[wordNo];
+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 |= positiveWindow;
+	*(memoryBaseAddress + FRAME_HEADER_OFFSET) = word;
+}
+
+void PdecConfig::writeFrameHeaderSecondOctet() {
+	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;
+}
+
+
+