action
container
contrib
controller
coordinates
datalinklayer
datapool
datapoolglob
datapoollocal
devicehandlers
events
fdir
globalfunctions
health
housekeeping
internalError
ipc
memory
modes
monitoring
objectmanager
osal
parameters
power
pus
returnvalues
rmap
serialize
serviceinterface
storagemanager
subsystem
tasks
tcdistribution
thermal
timemanager
tmstorage
tmtcpacket
tmtcservices
AcceptsTelecommandsIF.h
AcceptsTelemetryIF.h
AcceptsVerifyMessageIF.h
CommandingServiceBase.cpp
CommandingServiceBase.h
PusServiceBase.cpp
PusServiceBase.h
PusVerificationReport.cpp
PusVerificationReport.h
ServiceTypes.h
SourceSequenceCounter.h
TmTcBridge.cpp
TmTcBridge.h
TmTcMessage.cpp
TmTcMessage.h
VerificationCodes.h
VerificationReporter.cpp
VerificationReporter.h
.gitignore
LICENSE
NOTICE
fsfw.mk
106 lines
3.8 KiB
C++
106 lines
3.8 KiB
C++
#include "../tmtcservices/VerificationReporter.h"
|
|
|
|
#include "../ipc/MessageQueueIF.h"
|
|
#include "../tmtcservices/AcceptsVerifyMessageIF.h"
|
|
#include "../tmtcservices/PusVerificationReport.h"
|
|
#include "../serviceinterface/ServiceInterfaceStream.h"
|
|
#include "../objectmanager/frameworkObjects.h"
|
|
|
|
object_id_t VerificationReporter::messageReceiver = objects::PUS_SERVICE_1;
|
|
|
|
VerificationReporter::VerificationReporter() :
|
|
acknowledgeQueue(MessageQueueIF::NO_QUEUE) {
|
|
}
|
|
|
|
VerificationReporter::~VerificationReporter() {}
|
|
|
|
void VerificationReporter::sendSuccessReport(uint8_t set_report_id,
|
|
TcPacketBase* current_packet, uint8_t set_step) {
|
|
if (acknowledgeQueue == MessageQueueIF::NO_QUEUE) {
|
|
this->initialize();
|
|
}
|
|
PusVerificationMessage message(set_report_id,
|
|
current_packet->getAcknowledgeFlags(),
|
|
current_packet->getPacketId(),
|
|
current_packet->getPacketSequenceControl(), 0, set_step);
|
|
ReturnValue_t status = MessageQueueSenderIF::sendMessage(acknowledgeQueue,
|
|
&message);
|
|
if (status != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::error << "VerificationReporter::sendSuccessReport: Error writing "
|
|
<< "to queue. Code: " << std::hex << status << std::dec
|
|
<< std::endl;
|
|
}
|
|
}
|
|
|
|
void VerificationReporter::sendSuccessReport(uint8_t set_report_id,
|
|
uint8_t ackFlags, uint16_t tcPacketId, uint16_t tcSequenceControl,
|
|
uint8_t set_step) {
|
|
if (acknowledgeQueue == MessageQueueIF::NO_QUEUE) {
|
|
this->initialize();
|
|
}
|
|
PusVerificationMessage message(set_report_id, ackFlags, tcPacketId,
|
|
tcSequenceControl, 0, set_step);
|
|
ReturnValue_t status = MessageQueueSenderIF::sendMessage(acknowledgeQueue,
|
|
&message);
|
|
if (status != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::error << "VerificationReporter::sendSuccessReport: Error writing "
|
|
<< "to queue. Code: " << std::hex << status << std::dec
|
|
<< std::endl;
|
|
}
|
|
}
|
|
|
|
void VerificationReporter::sendFailureReport(uint8_t report_id,
|
|
TcPacketBase* current_packet, ReturnValue_t error_code, uint8_t step,
|
|
uint32_t parameter1, uint32_t parameter2) {
|
|
if (acknowledgeQueue == MessageQueueIF::NO_QUEUE) {
|
|
this->initialize();
|
|
}
|
|
PusVerificationMessage message(report_id,
|
|
current_packet->getAcknowledgeFlags(),
|
|
current_packet->getPacketId(),
|
|
current_packet->getPacketSequenceControl(), error_code, step,
|
|
parameter1, parameter2);
|
|
ReturnValue_t status = MessageQueueSenderIF::sendMessage(acknowledgeQueue,
|
|
&message);
|
|
if (status != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::error << "VerificationReporter::sendFailureReport Error writing "
|
|
<< "to queue. Code: " << std::hex << status << std::dec
|
|
<< std::endl;
|
|
}
|
|
}
|
|
|
|
void VerificationReporter::sendFailureReport(uint8_t report_id,
|
|
uint8_t ackFlags, uint16_t tcPacketId, uint16_t tcSequenceControl,
|
|
ReturnValue_t error_code, uint8_t step, uint32_t parameter1,
|
|
uint32_t parameter2) {
|
|
if (acknowledgeQueue == MessageQueueIF::NO_QUEUE) {
|
|
this->initialize();
|
|
}
|
|
PusVerificationMessage message(report_id, ackFlags, tcPacketId,
|
|
tcSequenceControl, error_code, step, parameter1, parameter2);
|
|
ReturnValue_t status = MessageQueueSenderIF::sendMessage(acknowledgeQueue,
|
|
&message);
|
|
if (status != HasReturnvaluesIF::RETURN_OK) {
|
|
sif::error << "VerificationReporter::sendFailureReport Error writing "
|
|
<< "to queue. Code: " << std::hex << status << std::dec
|
|
<< std::endl;
|
|
}
|
|
}
|
|
|
|
void VerificationReporter::initialize() {
|
|
if(messageReceiver == objects::NO_OBJECT) {
|
|
sif::warning << "VerificationReporter::initialize: Verification message"
|
|
" receiver object ID not set yet in Factory!" << std::endl;
|
|
return;
|
|
}
|
|
AcceptsVerifyMessageIF* temp = objectManager->get<AcceptsVerifyMessageIF>(
|
|
messageReceiver);
|
|
if (temp == nullptr) {
|
|
sif::error << "VerificationReporter::initialize: Message "
|
|
<< "receiver invalid. Make sure it is set up properly and "
|
|
<<"implementsAcceptsVerifyMessageIF" << std::endl;
|
|
|
|
}
|
|
this->acknowledgeQueue = temp->getVerificationQueue();
|
|
}
|