92 lines
2.9 KiB
C++
92 lines
2.9 KiB
C++
|
#include <framework/pus/Service5EventReporting.h>
|
||
|
|
#include <framework/pus/servicepackets/Service5Packets.h>
|
||
|
|
|
||
|
|
#include <framework/serviceinterface/ServiceInterfaceStream.h>
|
||
|
|
#include <framework/events/EventManagerIF.h>
|
||
|
|
#include <framework/ipc/QueueFactory.h>
|
||
|
|
#include <framework/tmtcpacket/pus/TmPacketStored.h>
|
||
|
|
|
||
|
|
|
||
|
|
Service5EventReporting::Service5EventReporting(object_id_t objectId,
|
||
|
|
uint16_t apid, uint8_t serviceId, size_t maxNumberReportsPerCycle):
|
||
|
|
PusServiceBase(objectId, apid, serviceId),
|
||
|
|
maxNumberReportsPerCycle(maxNumberReportsPerCycle) {
|
||
|
|
eventQueue = QueueFactory::instance()->createMessageQueue();
|
||
|
|
}
|
||
|
|
|
||
|
|
Service5EventReporting::~Service5EventReporting(){}
|
||
|
|
|
||
|
|
ReturnValue_t Service5EventReporting::performService() {
|
||
|
|
EventMessage message;
|
||
|
|
ReturnValue_t status = RETURN_OK;
|
||
|
|
for(uint8_t counter = 0;
|
||
|
|
counter < maxNumberReportsPerCycle;
|
||
|
|
counter++)
|
||
|
|
{
|
||
|
|
// Receive messages even if reporting is disabled for now.
|
||
|
|
status = eventQueue->receiveMessage(&message);
|
||
|
|
if(status == MessageQueueIF::EMPTY) {
|
||
|
|
return HasReturnvaluesIF::RETURN_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
if(enableEventReport) {
|
||
|
|
status = generateEventReport(message);
|
||
|
|
if(status != HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
return status;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
sif::debug << "Service5EventReporting::generateEventReport:"
|
||
|
|
" Too many events" << std::endl;
|
||
|
|
return HasReturnvaluesIF::RETURN_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
ReturnValue_t Service5EventReporting::generateEventReport(
|
||
|
|
EventMessage message)
|
||
|
|
{
|
||
|
|
EventReport report(message.getEventId(),message.getReporter(),
|
||
|
|
message.getParameter1(),message.getParameter2());
|
||
|
|
TmPacketStored tmPacket(PusServiceBase::apid, PusServiceBase::serviceId,
|
||
|
|
message.getSeverity(), packetSubCounter++, &report);
|
||
|
|
ReturnValue_t result = tmPacket.sendPacket(
|
||
|
|
requestQueue->getDefaultDestination(),requestQueue->getId());
|
||
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
sif::debug << "Service5EventReporting::generateEventReport:"
|
||
|
|
" Could not send TM packet" << std::endl;
|
||
|
|
}
|
||
|
|
return result;
|
||
|
|
}
|
||
|
|
|
||
|
|
ReturnValue_t Service5EventReporting::handleRequest(uint8_t subservice) {
|
||
|
|
switch(subservice) {
|
||
|
|
case Subservice::ENABLE: {
|
||
|
|
enableEventReport = true;
|
||
|
|
return HasReturnvaluesIF::RETURN_OK;
|
||
|
|
}
|
||
|
|
case Subservice::DISABLE: {
|
||
|
|
enableEventReport = false;
|
||
|
|
return HasReturnvaluesIF::RETURN_OK;
|
||
|
|
}
|
||
|
|
default:
|
||
|
|
return AcceptsTelecommandsIF::INVALID_SUBSERVICE;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
// In addition to the default PUSServiceBase initialization, this service needs
|
||
|
|
// to be registered to the event manager to listen for events.
|
||
|
|
ReturnValue_t Service5EventReporting::initialize() {
|
||
|
|
EventManagerIF* manager = objectManager->get<EventManagerIF>(
|
||
|
|
objects::EVENT_MANAGER);
|
||
|
|
if (manager == NULL) {
|
||
|
|
return RETURN_FAILED;
|
||
|
|
}
|
||
|
|
// register Service 5 as listener for events
|
||
|
|
ReturnValue_t result = manager->registerListener(eventQueue->getId(),true);
|
||
|
|
if(result != HasReturnvaluesIF::RETURN_OK) {
|
||
|
|
return result;
|
||
|
|
}
|
||
|
|
return PusServiceBase::initialize();
|
||
|
|
}
|