53 lines
1.7 KiB
C++
53 lines
1.7 KiB
C++
#include "fsfw/pus/Service17Test.h"
|
|
|
|
#include "fsfw/FSFW.h"
|
|
#include "fsfw/objectmanager/ObjectManager.h"
|
|
#include "fsfw/objectmanager/SystemObject.h"
|
|
#include "fsfw/tmtcservices/tmHelpers.h"
|
|
|
|
Service17Test::Service17Test(object_id_t objectId, uint16_t apid, uint8_t serviceId)
|
|
: PusServiceBase(objectId, apid, serviceId),
|
|
storeHelper(apid),
|
|
sendHelper(nullptr),
|
|
packetSubCounter(0) {}
|
|
|
|
Service17Test::~Service17Test() = default;
|
|
|
|
ReturnValue_t Service17Test::handleRequest(uint8_t subservice) {
|
|
switch (subservice) {
|
|
case Subservice::CONNECTION_TEST: {
|
|
storeHelper.preparePacket(serviceId, Subservice::CONNECTION_TEST_REPORT, packetSubCounter);
|
|
return telemetry::storeAndSendTmPacket(storeHelper, sendHelper);
|
|
}
|
|
case Subservice::EVENT_TRIGGER_TEST: {
|
|
storeHelper.preparePacket(serviceId, Subservice::CONNECTION_TEST_REPORT, packetSubCounter++);
|
|
triggerEvent(TEST, 1234, 5678);
|
|
return telemetry::storeAndSendTmPacket(storeHelper, sendHelper);
|
|
}
|
|
default:
|
|
return AcceptsTelecommandsIF::INVALID_SUBSERVICE;
|
|
}
|
|
}
|
|
|
|
ReturnValue_t Service17Test::performService() { return HasReturnvaluesIF::RETURN_OK; }
|
|
|
|
ReturnValue_t Service17Test::initialize() {
|
|
ReturnValue_t result = PusServiceBase::initialize();
|
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
|
return result;
|
|
}
|
|
initializeTmHelpers(sendHelper, storeHelper);
|
|
if (storeHelper.getTmStore() == nullptr) {
|
|
auto* tmStore = ObjectManager::instance()->get<StorageManagerIF>(objects::TM_STORE);
|
|
if (tmStore == nullptr) {
|
|
return ObjectManagerIF::CHILD_INIT_FAILED;
|
|
}
|
|
storeHelper.setTmStore(tmStore);
|
|
}
|
|
return result;
|
|
}
|
|
|
|
void Service17Test::setCustomTmStore(StorageManagerIF* tmStore_) {
|
|
storeHelper.setTmStore(tmStore_);
|
|
}
|