2020-09-16 16:22:36 +02:00
|
|
|
#include <fsfw/objectmanager/ObjectManagerIF.h>
|
|
|
|
#include <fsfw/serviceinterface/ServiceInterfaceStream.h>
|
|
|
|
#include <fsfw/devicehandlers/DeviceHandlerIF.h>
|
|
|
|
#include <fsfw/tasks/FixedTimeslotTaskIF.h>
|
2020-11-20 18:10:39 +01:00
|
|
|
#include <fsfwconfig/objects/systemObjectList.h>
|
|
|
|
#include <fsfwconfig/pollingsequence/PollingSequenceFactory.h>
|
2020-09-16 16:22:36 +02:00
|
|
|
|
|
|
|
ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence)
|
|
|
|
{
|
|
|
|
/* Length of a communication cycle */
|
|
|
|
uint32_t length = thisSequence->getPeriodMs();
|
|
|
|
|
2021-01-08 09:34:43 +01:00
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1,
|
|
|
|
length * 0, DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1,
|
|
|
|
length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1,
|
|
|
|
length * 0.4, DeviceHandlerIF::GET_WRITE);
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1,
|
|
|
|
length * 0.6, DeviceHandlerIF::SEND_READ);
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1,
|
|
|
|
length * 0.8, DeviceHandlerIF::GET_READ);
|
2020-09-16 16:22:36 +02:00
|
|
|
|
|
|
|
if (thisSequence->checkSequence() == HasReturnvaluesIF::RETURN_OK) {
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
sif::error << "PollingSequence::initialize has errors!" << std::endl;
|
|
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2020-12-09 12:00:24 +01:00
|
|
|
ReturnValue_t pst::gomspacePstInit(FixedTimeslotTaskIF *thisSequence){
|
|
|
|
|
|
|
|
uint32_t length = thisSequence->getPeriodMs();
|
|
|
|
|
2020-12-28 11:02:24 +01:00
|
|
|
thisSequence->addSlot(objects::P60DOCK_HANDLER,
|
|
|
|
length * 0, DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
thisSequence->addSlot(objects::PDU1_HANDLER,
|
|
|
|
length * 0, DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
thisSequence->addSlot(objects::PDU2_HANDLER,
|
|
|
|
length * 0, DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
thisSequence->addSlot(objects::ACU_HANDLER,
|
|
|
|
length * 0, DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
|
2020-12-09 12:00:24 +01:00
|
|
|
thisSequence->addSlot(objects::P60DOCK_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU1_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU2_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
2020-12-21 10:26:28 +01:00
|
|
|
thisSequence->addSlot(objects::ACU_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
2020-12-20 13:31:44 +01:00
|
|
|
|
2020-12-09 12:00:24 +01:00
|
|
|
thisSequence->addSlot(objects::P60DOCK_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.4, DeviceHandlerIF::GET_WRITE);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU1_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.4, DeviceHandlerIF::GET_WRITE);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU2_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.4, DeviceHandlerIF::GET_WRITE);
|
2020-12-21 10:26:28 +01:00
|
|
|
thisSequence->addSlot(objects::ACU_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.4, DeviceHandlerIF::GET_WRITE);
|
2020-12-20 13:31:44 +01:00
|
|
|
|
2020-12-09 12:00:24 +01:00
|
|
|
thisSequence->addSlot(objects::P60DOCK_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.6, DeviceHandlerIF::SEND_READ);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU1_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.6, DeviceHandlerIF::SEND_READ);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU2_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.6, DeviceHandlerIF::SEND_READ);
|
2020-12-21 10:26:28 +01:00
|
|
|
thisSequence->addSlot(objects::ACU_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.6, DeviceHandlerIF::SEND_READ);
|
2020-12-20 13:31:44 +01:00
|
|
|
|
2020-12-09 12:00:24 +01:00
|
|
|
thisSequence->addSlot(objects::P60DOCK_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.8, DeviceHandlerIF::GET_READ);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU1_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.8, DeviceHandlerIF::GET_READ);
|
2020-12-20 17:35:03 +01:00
|
|
|
thisSequence->addSlot(objects::PDU2_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.8, DeviceHandlerIF::GET_READ);
|
2020-12-21 10:26:28 +01:00
|
|
|
thisSequence->addSlot(objects::ACU_HANDLER,
|
2021-01-08 09:34:43 +01:00
|
|
|
length * 0.8, DeviceHandlerIF::GET_READ);
|
2020-12-09 12:00:24 +01:00
|
|
|
|
|
|
|
if (thisSequence->checkSequence() == HasReturnvaluesIF::RETURN_OK) {
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
sif::error << "Initialization of GomSpace PST failed" << std::endl;
|
|
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|