mission and config folders added , make file is added

mission/utility/PusPacketCreator.cpp

@@ -0,0 +1,20 @@
+#include <fsfw/tmtcpacket/pus/TcPacketBase.h>
+#include <fsfw/tmtcpacket/pus/TmPacketBase.h>
+#include <fsfw/globalfunctions/arrayprinter.h>
+#include <fsfw/serviceinterface/ServiceInterfaceStream.h>
+#include <mission/utility/PusPacketCreator.h>
+#include <iomanip>
+
+void PusPacketCreator::createPusPacketAndPrint() {
+	// TODO: use TC packet stored here instead..
+
+//	uint8_t packetStore[TcPacketBase::TC_PACKET_MIN_SIZE];
+//	TcPacketBase packet(packetStore);
+//	packet.initSpacePacketHeader(true, true, 0x73, 25);
+//	packet.initializeTcPacket(0x73, 25, 0, 17, 1);
+//	packet.setPacketDataLength(sizeof(PUSTcDataFieldHeader)
+//			+ TcPacketBase::CRC_SIZE-1);
+//	packet.setErrorControl();
+//	sif::info << "PUS packet created: " << std::endl;
+//	arrayprinter::print(packet.getWholeData(), packet.getFullSize());
+}

mission/utility/PusPacketCreator.h

@@ -0,0 +1,16 @@
+/*
+ * PusPacketCreator.h
+ *
+ *  Created on: 21.03.2019
+ *      Author: gaisser
+ */
+
+#ifndef MISSION_UTILITY_PUSPACKETCREATOR_H_
+#define MISSION_UTILITY_PUSPACKETCREATOR_H_
+
+class PusPacketCreator {
+public:
+	static void createPusPacketAndPrint();
+};
+
+#endif /* MISSION_UTILITY_PUSPACKETCREATOR_H_ */

mission/utility/TmFunnel.cpp

@@ -0,0 +1,115 @@
+#include <fsfw/ipc/QueueFactory.h>
+#include <fsfw/tmtcpacket/pus/TmPacketBase.h>
+#include <fsfw/tmtcpacket/pus/TmPacketStored.h>
+#include <fsfw/serviceinterface/ServiceInterfaceStream.h>
+#include <mission/utility/TmFunnel.h>
+
+object_id_t TmFunnel::downlinkDestination = objects::NO_OBJECT;
+object_id_t TmFunnel::storageDestination = objects::NO_OBJECT;
+
+TmFunnel::TmFunnel(object_id_t objectId, uint32_t messageDepth):
+        SystemObject(objectId), messageDepth(messageDepth) {
+	tmQueue = QueueFactory::instance()->createMessageQueue(messageDepth,
+	        MessageQueueMessage::MAX_MESSAGE_SIZE);
+	storageQueue = QueueFactory::instance()->createMessageQueue(messageDepth,
+	        MessageQueueMessage::MAX_MESSAGE_SIZE);
+}
+
+TmFunnel::~TmFunnel() {
+}
+
+MessageQueueId_t TmFunnel::getReportReceptionQueue(uint8_t virtualChannel) {
+	return tmQueue->getId();
+}
+
+ReturnValue_t TmFunnel::performOperation(uint8_t operationCode) {
+	TmTcMessage currentMessage;
+	ReturnValue_t status = tmQueue->receiveMessage(&currentMessage);
+	while(status == HasReturnvaluesIF::RETURN_OK)
+	{
+		status = handlePacket(&currentMessage);
+		if(status != HasReturnvaluesIF::RETURN_OK){
+			break;
+		}
+		status = tmQueue->receiveMessage(&currentMessage);
+	}
+
+	if (status == MessageQueueIF::EMPTY) {
+		return HasReturnvaluesIF::RETURN_OK;
+	}
+	else {
+		return status;
+	}
+}
+
+ReturnValue_t TmFunnel::handlePacket(TmTcMessage* message) {
+	uint8_t* packetData = nullptr;
+	size_t size = 0;
+	ReturnValue_t result = tmPool->modifyData(message->getStorageId(),
+	        &packetData, &size);
+	if(result != HasReturnvaluesIF::RETURN_OK){
+		return result;
+	}
+	TmPacketBase packet(packetData);
+	packet.setPacketSequenceCount(this->sourceSequenceCount);
+	sourceSequenceCount++;
+	sourceSequenceCount = sourceSequenceCount %
+	        SpacePacketBase::LIMIT_SEQUENCE_COUNT;
+	packet.setErrorControl();
+
+	result = tmQueue->sendToDefault(message);
+	if(result != HasReturnvaluesIF::RETURN_OK){
+		tmPool->deleteData(message->getStorageId());
+		sif::error << "TmFunnel::handlePacket: Error sending to downlink "
+				"handler" << std::endl;
+		return result;
+	}
+
+	if(storageDestination != objects::NO_OBJECT) {
+		result = storageQueue->sendToDefault(message);
+		if(result != HasReturnvaluesIF::RETURN_OK){
+			tmPool->deleteData(message->getStorageId());
+			sif::error << "TmFunnel::handlePacket: Error sending to storage "
+					"handler" << std::endl;
+			return result;
+		}
+	}
+	return result;
+}
+
+ReturnValue_t TmFunnel::initialize() {
+
+	tmPool = objectManager->get<StorageManagerIF>(objects::TM_STORE);
+	if(tmPool == nullptr) {
+		sif::error << "TmFunnel::initialize: TM store not set."
+				<< std::endl;
+		sif::error << "Make sure the tm store is set up properly"
+				" and implements StorageManagerIF" << std::endl;
+		return ObjectManagerIF::CHILD_INIT_FAILED;
+	}
+
+	AcceptsTelemetryIF* tmTarget =
+	        objectManager->get<AcceptsTelemetryIF>(downlinkDestination);
+	if(tmTarget == nullptr){
+		sif::error << "TmFunnel::initialize: Downlink Destination not set."
+				<< std::endl;
+		sif::error << "Make sure the downlink destination object is set up "
+				"properly and implements AcceptsTelemetryIF" << std::endl;
+		return ObjectManagerIF::CHILD_INIT_FAILED;
+	}
+	tmQueue->setDefaultDestination(tmTarget->getReportReceptionQueue());
+
+	// Storage destination is optional.
+	if(storageDestination == objects::NO_OBJECT) {
+	    return SystemObject::initialize();
+	}
+
+	AcceptsTelemetryIF* storageTarget =
+	        objectManager->get<AcceptsTelemetryIF>(storageDestination);
+	if(storageTarget != nullptr) {
+		storageQueue->setDefaultDestination(
+		        storageTarget->getReportReceptionQueue());
+	}
+
+	return SystemObject::initialize();
+}

mission/utility/TmFunnel.h

@@ -0,0 +1,50 @@
+#ifndef MISSION_UTILITY_TMFUNNEL_H_
+#define MISSION_UTILITY_TMFUNNEL_H_
+
+#include <fsfw/objectmanager/SystemObject.h>
+#include <fsfw/tasks/ExecutableObjectIF.h>
+#include <fsfw/tmtcservices/AcceptsTelemetryIF.h>
+#include <fsfw/ipc/MessageQueueIF.h>
+#include <fsfw/tmtcservices/TmTcMessage.h>
+
+namespace Factory{
+void setStaticFrameworkObjectIds();
+}
+
+/**
+ * @brief       TM Recipient.
+ * @details
+ * Main telemetry receiver. All generated telemetry is funneled into
+ * this object.
+ * @ingroup     utility
+ * @author      J. Meier
+ */
+class TmFunnel: public AcceptsTelemetryIF,
+		public ExecutableObjectIF,
+		public SystemObject {
+	friend void (Factory::setStaticFrameworkObjectIds)();
+public:
+	TmFunnel(object_id_t objectId, uint32_t messageDepth = 20);
+	virtual ~TmFunnel();
+
+	virtual MessageQueueId_t getReportReceptionQueue(
+			uint8_t virtualChannel = 0) override;
+	virtual ReturnValue_t performOperation(uint8_t operationCode = 0) override;
+	virtual ReturnValue_t initialize() override;
+
+protected:
+	static object_id_t downlinkDestination;
+	static object_id_t storageDestination;
+
+private:
+	uint16_t sourceSequenceCount = 0;
+	MessageQueueIF* tmQueue = nullptr;
+	MessageQueueIF* storageQueue = nullptr;
+
+	StorageManagerIF* tmPool = nullptr;
+	uint32_t messageDepth = 0;
+
+	ReturnValue_t handlePacket(TmTcMessage* message);
+};
+
+#endif /* MISSION_UTILITY_TMFUNNEL_H_ */