This commit is contained in:
@ -3,33 +3,33 @@
|
||||
#include "devices/gpioIds.h"
|
||||
|
||||
PayloadPcduHandler::PayloadPcduHandler(object_id_t objectId, object_id_t comIF, CookieIF* cookie,
|
||||
GpioIF* gpioIF)
|
||||
GpioIF* gpioIF)
|
||||
: DeviceHandlerBase(objectId, comIF, cookie), state(States::ADC_OFF_PL_OFF), gpioIF(gpioIF) {}
|
||||
|
||||
void PayloadPcduHandler::doStartUp() {
|
||||
switch(state) {
|
||||
case(States::ADC_OFF_PL_OFF): {
|
||||
// Switch on relays here
|
||||
gpioIF->pullHigh(gpioIds::PLPCDU_ENB_VBAT0);
|
||||
gpioIF->pullHigh(gpioIds::PLPCDU_ENB_VBAT1);
|
||||
state = States::SWITCH_ON_RELAY_TRANSITION;
|
||||
break;
|
||||
}
|
||||
case(States::SWITCH_ON_RELAY_TRANSITION): {
|
||||
// If necessary, check whether a certain amount of time has elapsed
|
||||
state = States::ADC_OFF_PL_OFF;
|
||||
break;
|
||||
}
|
||||
default:
|
||||
// Config error
|
||||
sif::error << "PayloadPcduHandler::doStartUp: Invalid state" << std::endl;
|
||||
switch (state) {
|
||||
case (States::ADC_OFF_PL_OFF): {
|
||||
// Switch on relays here
|
||||
gpioIF->pullHigh(gpioIds::PLPCDU_ENB_VBAT0);
|
||||
gpioIF->pullHigh(gpioIds::PLPCDU_ENB_VBAT1);
|
||||
state = States::SWITCH_ON_RELAY_TRANSITION;
|
||||
break;
|
||||
}
|
||||
case (States::SWITCH_ON_RELAY_TRANSITION): {
|
||||
// If necessary, check whether a certain amount of time has elapsed
|
||||
state = States::ADC_OFF_PL_OFF;
|
||||
break;
|
||||
}
|
||||
default:
|
||||
// Config error
|
||||
sif::error << "PayloadPcduHandler::doStartUp: Invalid state" << std::endl;
|
||||
}
|
||||
}
|
||||
|
||||
void PayloadPcduHandler::doTransition(Mode_t modeFrom, Submode_t subModeFrom) {
|
||||
if(mode == _MODE_TO_NORMAL) {
|
||||
switch(state) {
|
||||
case(States::ADC_OFF_PL_OFF): {
|
||||
if (mode == _MODE_TO_NORMAL) {
|
||||
switch (state) {
|
||||
case (States::ADC_OFF_PL_OFF): {
|
||||
// Switch on HPA here
|
||||
gpioIF->pullHigh(gpioIds::PLPCDU_ENB_DRO);
|
||||
gpioIF->pullHigh(gpioIds::PLPCDU_ENB_MPA);
|
||||
@ -39,7 +39,7 @@ void PayloadPcduHandler::doTransition(Mode_t modeFrom, Submode_t subModeFrom) {
|
||||
state = States::SWITCH_ON_HPA_TRANSITION;
|
||||
break;
|
||||
}
|
||||
case(States::SWITCH_ON_HPA_TRANSITION): {
|
||||
case (States::SWITCH_ON_HPA_TRANSITION): {
|
||||
// If necessary, check whether a certain amount of time has elapsed
|
||||
state = States::ADC_ON_PL_ON;
|
||||
setMode(MODE_NORMAL);
|
||||
@ -48,7 +48,7 @@ void PayloadPcduHandler::doTransition(Mode_t modeFrom, Submode_t subModeFrom) {
|
||||
default:
|
||||
// Config error
|
||||
sif::error << "PayloadPcduHandler::doTransition: Invalid state" << std::endl;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
@ -82,8 +82,6 @@ ReturnValue_t PayloadPcduHandler::interpretDeviceReply(DeviceCommandId_t id,
|
||||
|
||||
uint32_t PayloadPcduHandler::getTransitionDelayMs(Mode_t modeFrom, Mode_t modeTo) { return 10000; }
|
||||
|
||||
|
||||
|
||||
ReturnValue_t PayloadPcduHandler::initializeLocalDataPool(localpool::DataPool& localDataPoolMap,
|
||||
LocalDataPoolManager& poolManager) {
|
||||
return HasReturnvaluesIF::RETURN_OK;
|
||||
|
@ -2,6 +2,7 @@
|
||||
#define LINUX_DEVICES_PLPCDUHANDLER_H_
|
||||
|
||||
#include <fsfw/devicehandlers/DeviceHandlerBase.h>
|
||||
|
||||
#include "fsfw_hal/common/gpio/GpioIF.h"
|
||||
|
||||
class PayloadPcduHandler : DeviceHandlerBase {
|
||||
|
Reference in New Issue
Block a user