APID getter bugfix

src/fsfw/tcdistribution/CCSDSDistributor.h

@@ -31,7 +31,7 @@ class CCSDSDistributor : public TcDistributor,
   /**
    * The destructor is empty.
    */
-  virtual ~CCSDSDistributor();
+  ~CCSDSDistributor() override;
 
   MessageQueueId_t getRequestQueue() override;
   ReturnValue_t registerApplication(uint16_t apid, MessageQueueId_t id) override;

src/fsfw/tmtcpacket/ccsds/SpacePacketIF.h

@@ -51,9 +51,8 @@ class SpacePacketIF {
   virtual PacketSeqCtrl getPacketSeqCtrl() { return PacketSeqCtrl::fromRaw(getPacketSeqCtrlRaw()); }
 
   [[nodiscard]] virtual uint16_t getApid() const {
-    uint16_t packetId = getPacketIdRaw();
     // Uppermost 11 bits of packet ID
-    return ((packetId >> 8) & 0b111) | (packetId & 0xFF);
+    return getPacketIdRaw() & 0x7ff;
   }
 
   /**

src/fsfw/tmtcpacket/pus/tm/PusTmCreator.cpp

@@ -13,17 +13,27 @@ PusTmCreator::PusTmCreator(SpacePacketParams initSpParams, PusTmParams initPusPa
 PusTmCreator::PusTmCreator() { setup(); }
 
 uint16_t PusTmCreator::getPacketIdRaw() const { return spCreator.getPacketIdRaw(); }
+
 uint16_t PusTmCreator::getPacketSeqCtrlRaw() const { return spCreator.getPacketSeqCtrlRaw(); }
+
 uint16_t PusTmCreator::getPacketDataLen() const { return spCreator.getPacketDataLen(); }
+
 uint8_t PusTmCreator::getPusVersion() const { return pusParams.secHeader.pusVersion; }
+
 uint8_t PusTmCreator::getService() const { return pusParams.secHeader.service; }
+
 uint8_t PusTmCreator::getSubService() const { return pusParams.secHeader.subservice; }
+
 PusTmParams& PusTmCreator::getParams() { return pusParams; }
+
 void PusTmCreator::setTimeStamper(TimeStamperIF* timeStamper_) {
   pusParams.secHeader.timeStamper = timeStamper_;
 }
+
 uint8_t PusTmCreator::getScTimeRefStatus() { return pusParams.secHeader.scTimeRefStatus; }
+
 uint16_t PusTmCreator::getMessageTypeCounter() { return pusParams.secHeader.messageTypeCounter; }
+
 uint16_t PusTmCreator::getDestId() { return pusParams.secHeader.destId; }
 
 ReturnValue_t PusTmCreator::serialize(uint8_t** buffer, size_t* size, size_t maxSize,
@@ -83,7 +93,9 @@ ReturnValue_t PusTmCreator::deSerialize(const uint8_t** buffer, size_t* size,
 }
 
 ecss::DataWrapper& PusTmCreator::getDataWrapper() { return pusParams.dataWrapper; }
+
 TimeStamperIF* PusTmCreator::getTimestamper() const { return pusParams.secHeader.timeStamper; }
+
 SpacePacketParams& PusTmCreator::getSpParams() { return spCreator.getParams(); }
 
 void PusTmCreator::updateSpLengthField() {
@@ -105,3 +117,22 @@ void PusTmCreator::setup() {
   updateSpLengthField();
   spCreator.setPacketType(ccsds::PacketType::TM);
 }
+
+void PusTmCreator::setMessageTypeCounter(uint16_t messageTypeCounter) {
+  pusParams.secHeader.messageTypeCounter = messageTypeCounter;
+};
+
+void PusTmCreator::setDestId(uint16_t destId) { pusParams.secHeader.destId = destId; }
+
+void PusTmCreator::setRawSourceData(ecss::DataWrapper::BufPairT bufPair) {
+  pusParams.dataWrapper.type = ecss::DataTypes::RAW;
+  pusParams.dataWrapper.dataUnion.raw.data = bufPair.first;
+  pusParams.dataWrapper.dataUnion.raw.len = bufPair.second;
+  updateSpLengthField();
+}
+
+void PusTmCreator::setSerializableSourceData(SerializeIF* serializable) {
+  pusParams.dataWrapper.type = ecss::DataTypes::SERIALIZABLE;
+  pusParams.dataWrapper.dataUnion.serializable = serializable;
+  updateSpLengthField();
+}

src/fsfw/tmtcpacket/pus/tm/PusTmCreator.h

@@ -47,7 +47,11 @@ class PusTmCreator : public SerializeIF, public PusTmIF, public CreatorDataIF {
 
   void setTimeStamper(TimeStamperIF* timeStamper);
   SpacePacketParams& getSpParams();
+  void setRawSourceData(ecss::DataWrapper::BufPairT bufPair);
+  void setSerializableSourceData(SerializeIF* serializable);
   void setApid(uint16_t apid);
+  void setDestId(uint16_t destId);
+  void setMessageTypeCounter(uint16_t messageTypeCounter);
   PusTmParams& getParams();
   void updateSpLengthField();
   [[nodiscard]] uint16_t getPacketIdRaw() const override;