|
|
|
@ -5,13 +5,13 @@
|
|
|
|
|
#include <fsfw/devicehandlers/DeviceHandlerIF.h>
|
|
|
|
|
#include <fsfw/tasks/FixedTimeslotTaskIF.h>
|
|
|
|
|
#include <fsfwconfig/objects/systemObjectList.h>
|
|
|
|
|
#include <fsfwconfig/OBSWConfig.h>
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence)
|
|
|
|
|
{
|
|
|
|
|
/* Length of a communication cycle */
|
|
|
|
|
uint32_t length = thisSequence->getPeriodMs();
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1, length * 0,
|
|
|
|
|
DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_2, length * 0,
|
|
|
|
@ -40,6 +40,7 @@ ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence)
|
|
|
|
|
#endif /* Q7S_ADD_RTD_DEVICES */
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::IMTQ_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0, DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1, length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_2, length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
|
|
|
@ -64,6 +65,7 @@ ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence)
|
|
|
|
|
#endif /* Q7S_ADD_RTD_DEVICES */
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::IMTQ_HANDLER, length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.2, DeviceHandlerIF::SEND_WRITE);
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1, length * 0.4, DeviceHandlerIF::GET_WRITE);
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_2, length * 0.4, DeviceHandlerIF::GET_WRITE);
|
|
|
|
@ -88,6 +90,7 @@ ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence)
|
|
|
|
|
#endif /* Q7S_ADD_RTD_DEVICES */
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::IMTQ_HANDLER, length * 0.4, DeviceHandlerIF::GET_WRITE);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.4, DeviceHandlerIF::GET_WRITE);
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1, length * 0.6, DeviceHandlerIF::SEND_READ);
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_2, length * 0.6, DeviceHandlerIF::SEND_READ);
|
|
|
|
@ -112,6 +115,7 @@ ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence)
|
|
|
|
|
#endif /* Q7S_ADD_RTD_DEVICES */
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::IMTQ_HANDLER, length * 0.6, DeviceHandlerIF::SEND_READ);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.6, DeviceHandlerIF::SEND_READ);
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_1, length * 0.8, DeviceHandlerIF::GET_READ);
|
|
|
|
|
thisSequence->addSlot(objects::TMP1075_HANDLER_2, length * 0.8, DeviceHandlerIF::GET_READ);
|
|
|
|
@ -136,6 +140,7 @@ ReturnValue_t pst::pollingSequenceInitDefault(FixedTimeslotTaskIF *thisSequence)
|
|
|
|
|
#endif /* Q7S_ADD_RTD_DEVICES */
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::IMTQ_HANDLER, length * 0.8, DeviceHandlerIF::GET_READ);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.8, DeviceHandlerIF::GET_READ);
|
|
|
|
|
|
|
|
|
|
if (thisSequence->checkSequence() == HasReturnvaluesIF::RETURN_OK) {
|
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
|
|
@ -290,3 +295,25 @@ ReturnValue_t pst::pollingSequenceAcsTest(FixedTimeslotTaskIF *thisSequence) {
|
|
|
|
|
}
|
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ReturnValue_t pst::pollingSequenceTE0720(FixedTimeslotTaskIF *thisSequence) {
|
|
|
|
|
uint32_t length = thisSequence->getPeriodMs();
|
|
|
|
|
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0,
|
|
|
|
|
DeviceHandlerIF::PERFORM_OPERATION);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.2,
|
|
|
|
|
DeviceHandlerIF::SEND_WRITE);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.4,
|
|
|
|
|
DeviceHandlerIF::GET_WRITE);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.6,
|
|
|
|
|
DeviceHandlerIF::SEND_READ);
|
|
|
|
|
thisSequence->addSlot(objects::PLOC_HANDLER, length * 0.8,
|
|
|
|
|
DeviceHandlerIF::GET_READ);
|
|
|
|
|
|
|
|
|
|
if (thisSequence->checkSequence() != HasReturnvaluesIF::RETURN_OK) {
|
|
|
|
|
sif::error << "Initialization of TE0720 PST failed" << std::endl;
|
|
|
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
|
|
|
}
|
|
|
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|