#include "Compressor.h"

ZaphodCompressor::ZaphodCompressor()
{
  compressor = new Compressor(COMPRESSOR_GAUGE_SIDECAR, COMPRESSOR_GAUGE, COMPRESSOR_RELAY_SIDECAR, COMPRESSOR_RELAY);
  solenoid1 = new Solenoid(COMPRESSOR_SOLENOID_ONE);
  solenoid2 = new Solenoid(COMPRESSOR_SOLENOID_TWO);
}

void ZaphodCompressor::compressorSystemPeriodic()
{
  switch(e_CollectorSolenoidState)
  {
    case EXTENDED:
      solenoid1->Set(false);
      solenoid2->Set(true);
      e_CollectorSolenoidState = IDLE;
      break;
    case RETRACTED:
      solenoid1->Set(true);
      solenoid2->Set(false);
      e_CollectorSolenoidState = IDLE;
      break;
    case IDLE:
      e_CollectorSolenoidState = IDLE;
      break;
    default:
      break;
  }
}

void ZaphodCompressor::startCompressing()
{
  compressor->Start();
}

void ZaphodCompressor::stopCompressing()
{
  compressor->Stop();
}

void ZaphodCompressor::extendCollector()
{
  e_CollectorSolenoidState = EXTENDED;
}

void ZaphodCompressor::retractCollector()
{
  e_CollectorSolenoidState = RETRACTED;
}