Compressor.cpp

/*----------------------------------------------------------------------------*/
/* Copyright (c) FIRST 2008. All Rights Reserved.                                                         */
/* Open Source Software - may be modified and shared by FRC teams. The code   */
/* must be accompanied by the FIRST BSD license file in $(WIND_BASE)/WPILib.  */
/*----------------------------------------------------------------------------*/

#include "Compressor.h"
#include "DigitalInput.h"
#include "Timer.h"
#include "WPIErrors.h"

static void compressorChecker(Compressor *c)
{
        while (1)
        {
                if (c->Enabled())
                {
                        c->SetRelayValue( c->GetPressureSwitchValue() == 0 ? Relay::kOn : Relay::kOff );
                }
                else
                {
                        c->SetRelayValue(Relay::kOff);
                }
                Wait(0.5);
        }
}

void Compressor::InitCompressor(UINT8 pressureSwitchModuleNumber,
                UINT32 pressureSwitchChannel,
                UINT8 compresssorRelayModuleNumber,
                UINT32 compressorRelayChannel)
{
        m_enabled = false;
        m_pressureSwitch = new DigitalInput(pressureSwitchModuleNumber, pressureSwitchChannel);
        m_relay = new Relay(compresssorRelayModuleNumber, compressorRelayChannel, Relay::kForwardOnly);

        if (!m_task.Start((INT32)this))
        {
                wpi_setWPIError(CompressorTaskError);
        }
}

Compressor::Compressor(UINT8 pressureSwitchModuleNumber,
                UINT32 pressureSwitchChannel,
                UINT8 compresssorRelayModuleNumber,
                UINT32 compressorRelayChannel)
        : m_task ("Compressor", (FUNCPTR)compressorChecker)
{
        InitCompressor(pressureSwitchModuleNumber,
                pressureSwitchChannel,
                compresssorRelayModuleNumber,
                compressorRelayChannel);
}

Compressor::Compressor(UINT32 pressureSwitchChannel, UINT32 compressorRelayChannel)
        : m_task ("Compressor", (FUNCPTR)compressorChecker)
{
        InitCompressor(GetDefaultDigitalModule(),
                        pressureSwitchChannel,
                        GetDefaultDigitalModule(),
                        compressorRelayChannel);
}

Compressor::~Compressor()
{
        delete m_pressureSwitch;
        delete m_relay;
}

void Compressor::SetRelayValue(Relay::Value relayValue)
{
        m_relay->Set(relayValue);
}

UINT32 Compressor::GetPressureSwitchValue()
{
        return m_pressureSwitch->Get();
}

void Compressor::Start()
{
        m_enabled = true;
}

void Compressor::Stop()
{
        m_enabled = false;
}

bool Compressor::Enabled()
{
        return m_enabled;
}