eive-obsw/mission/system/objects/Stack5VHandler.cpp

#include "Stack5VHandler.h"

Stack5VHandler::Stack5VHandler(PowerSwitchIF& switcher) : switcher(switcher) {
  stackLock = MutexFactory::instance()->createMutex();
}

ReturnValue_t Stack5VHandler::deviceToOn(StackCommander commander, bool updateStates) {
  MutexGuard mg(stackLock);
  if (updateStates) {
    updateInternalStates();
  }
  if (switchIsOn) {
    if (commander == StackCommander::PL_PCDU) {
      plPcduIsOn = true;
    } else {
      radSensorIsOn = true;
    }
    return returnvalue::OK;
  }
  if (handlerState == HandlerState::SWITCH_PENDING) {
    return BUSY;
  }
  handlerState = HandlerState::SWITCH_PENDING;
  return switcher.sendSwitchCommand(stackSwitch, PowerSwitchIF::SWITCH_ON);
}

ReturnValue_t Stack5VHandler::deviceToOff(StackCommander commander, bool updateStates) {
  MutexGuard mg(stackLock);
  if (updateStates) {
    updateInternalStates();
  }
  if (not switchIsOn) {
    if (commander == StackCommander::PL_PCDU) {
      plPcduIsOn = false;
    } else {
      radSensorIsOn = false;
    }
    return returnvalue::OK;
  }
  if (handlerState == HandlerState::SWITCH_PENDING) {
    return BUSY;
  }
  if ((commander == StackCommander::PL_PCDU and radSensorIsOn) or
      (commander == StackCommander::RAD_SENSOR and plPcduIsOn)) {
    return returnvalue::OK;
  }
  handlerState = HandlerState::SWITCH_PENDING;
  return switcher.sendSwitchCommand(stackSwitch, PowerSwitchIF::SWITCH_OFF);
}

bool Stack5VHandler::isSwitchOn() {
  MutexGuard mg(stackLock);
  return updateInternalStates();
}

void Stack5VHandler::update() {
  MutexGuard mg(stackLock);
  updateInternalStates();
}

bool Stack5VHandler::updateInternalStates() {
  if (switcher.getSwitchState(stackSwitch) == PowerSwitchIF::SWITCH_ON) {
    if (not switchIsOn) {
      if (handlerState == HandlerState::SWITCH_PENDING) {
        handlerState = HandlerState::IDLE;
      }
      switchIsOn = true;
    }
    return true;
  }
  if (switchIsOn) {
    if (handlerState == HandlerState::SWITCH_PENDING) {
      handlerState = HandlerState::IDLE;
    }
    switchIsOn = false;
  }
  radSensorIsOn = false;
  plPcduIsOn = false;

  return false;
}