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) {
  MutexGuard mg(stackLock);
  if (switchIsOn or handlerState == HandlerState::SWITCH_PENDING) {
    return returnvalue::OK;
  }
  if (commander == StackCommander::PL_PCDU) {
    plPcduCommandedOn = true;
  } else if (commander == StackCommander::RAD_SENSOR) {
    radSensorCommandedOn = true;
  }
  return switcher.sendSwitchCommand(stackSwitch, PowerSwitchIF::SWITCH_ON);
}

ReturnValue_t Stack5VHandler::deviceToOff(StackCommander commander) {
  MutexGuard mg(stackLock);
  if (not switchIsOn) {
    return returnvalue::OK;
  }
  if (commander == StackCommander::PL_PCDU) {
    plPcduCommandedOn = true;
  } else if (commander == StackCommander::RAD_SENSOR) {
    radSensorCommandedOn = true;
  }
  return switcher.sendSwitchCommand(stackSwitch, PowerSwitchIF::SWITCH_OFF);
}

bool Stack5VHandler::isSwitchOn() {
  MutexGuard mg(stackLock);
  if (switcher.getSwitchState(stackSwitch) == PowerSwitchIF::SWITCH_ON) {
    if (not switchIsOn) {
      if (handlerState == HandlerState::SWITCH_PENDING) {
        handlerState = HandlerState::IDLE;
      }
      switchIsOn = true;
    }
    if (plPcduCommandedOn) {
      plPcduIsOn = true;
    }
    if (radSensorCommandedOn) {
      radSensorIsOn = true;
    }
    return true;
  } else {
    if (switchIsOn) {
      if (handlerState == HandlerState::SWITCH_PENDING) {
        handlerState = HandlerState::IDLE;
      }
      switchIsOn = false;
    }
    radSensorIsOn = false;
    plPcduIsOn = false;
    radSensorCommandedOn = false;
    plPcduCommandedOn = false;
  }
  return false;
}