From 65815e4646cdf4e9538d25d81079b8f4e9d3a860 Mon Sep 17 00:00:00 2001
From: Robin Mueller <muellerr@irs.uni-stuttgart.de>
Date: Wed, 14 Jun 2023 05:17:27 +0200
Subject: [PATCH] extend bpx handler

---
 mission/power/BpxBatteryHandler.cpp | 6 +++++-
 mission/power/bpxBattDefs.h         | 2 ++
 tmtc                                | 2 +-
 3 files changed, 8 insertions(+), 2 deletions(-)

diff --git a/mission/power/BpxBatteryHandler.cpp b/mission/power/BpxBatteryHandler.cpp
index b4aece40..96253705 100644
--- a/mission/power/BpxBatteryHandler.cpp
+++ b/mission/power/BpxBatteryHandler.cpp
@@ -1,4 +1,5 @@
 #include <fsfw/datapool/PoolReadGuard.h>
+#include <fsfw/globalfunctions/arrayprinter.h>
 #include <mission/power/BpxBatteryHandler.h>
 
 BpxBatteryHandler::BpxBatteryHandler(object_id_t objectId, object_id_t comIF, CookieIF* comCookie,
@@ -51,6 +52,9 @@ void BpxBatteryHandler::fillCommandAndReplyMap() {
   insertInCommandAndReplyMap(bpxBat::RESET_COUNTERS, 1, nullptr, EMPTY_REPLY_LEN);
   insertInCommandAndReplyMap(bpxBat::CONFIG_CMD, 1, nullptr, EMPTY_REPLY_LEN);
   insertInCommandAndReplyMap(bpxBat::CONFIG_GET, 1, &cfgSet, CONFIG_GET_REPLY_LEN);
+  insertInCommandAndReplyMap(bpxBat::CONFIG_SET, 1, nullptr, EMPTY_REPLY_LEN);
+  insertInCommandAndReplyMap(bpxBat::MAN_HEAT_ON, 1, nullptr, MAN_HEAT_REPLY_LEN);
+  insertInCommandAndReplyMap(bpxBat::MAN_HEAT_OFF, 1, nullptr, MAN_HEAT_REPLY_LEN);
 }
 
 ReturnValue_t BpxBatteryHandler::buildCommandFromCommand(DeviceCommandId_t deviceCommand,
@@ -155,7 +159,7 @@ ReturnValue_t BpxBatteryHandler::scanForReply(const uint8_t* start, size_t remai
     case (bpxBat::PING):
     case (bpxBat::MAN_HEAT_ON):
     case (bpxBat::MAN_HEAT_OFF): {
-      if (remainingSize != PING_REPLY_LEN) {
+      if (remainingSize != MAN_HEAT_REPLY_LEN) {
         return DeviceHandlerIF::LENGTH_MISSMATCH;
       }
       break;
diff --git a/mission/power/bpxBattDefs.h b/mission/power/bpxBattDefs.h
index 6df87efd..0e167f07 100644
--- a/mission/power/bpxBattDefs.h
+++ b/mission/power/bpxBattDefs.h
@@ -48,6 +48,7 @@ static constexpr uint32_t CFG_SET_ID = CONFIG_GET;
 static constexpr size_t GET_HK_REPLY_LEN = 23;
 static constexpr size_t PING_REPLY_LEN = 3;
 static constexpr size_t EMPTY_REPLY_LEN = 2;
+static constexpr size_t MAN_HEAT_REPLY_LEN = 3;
 static constexpr size_t CONFIG_GET_REPLY_LEN = 5;
 
 static constexpr uint8_t PORT_PING = 1;
@@ -219,6 +220,7 @@ class BpxBatteryCfg : public StaticLocalDataSet<bpxBat::CFG_ENTRIES> {
     if (size < 3) {
       return SerializeIF::STREAM_TOO_SHORT;
     }
+
     battheatermode.value = data[0];
     battheaterLow.value = data[1];
     battheaterHigh.value = data[2];
diff --git a/tmtc b/tmtc
index 522f273c..cf55b363 160000
--- a/tmtc
+++ b/tmtc
@@ -1 +1 @@
-Subproject commit 522f273c99845f9c50aaf135b1c6f52676b975dd
+Subproject commit cf55b3630c82c35639c39c6c0e28506ef55049e4