AnalogChannel.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 "AnalogChannel.h"
#include "AnalogModule.h"
#include "Resource.h"
#include "WPIErrors.h"

static Resource *channels = NULL;

const UINT8 AnalogChannel::kAccumulatorModuleNumber;
const UINT32 AnalogChannel::kAccumulatorNumChannels;
const UINT32 AnalogChannel::kAccumulatorChannels[] = {1, 2};

void AnalogChannel::InitChannel(UINT8 moduleNumber, UINT32 channel)
{
        char buf[64];
        Resource::CreateResourceObject(&channels, kAnalogModules * kAnalogChannels);
        if (!CheckAnalogModule(moduleNumber))
        {
                snprintf(buf, 64, "Analog Module %d", moduleNumber);
                wpi_setWPIErrorWithContext(ModuleIndexOutOfRange, buf);
                return;
        }
        if (!CheckAnalogChannel(channel))
        {
                snprintf(buf, 64, "Analog Channel %d", channel);
                wpi_setWPIErrorWithContext(ChannelIndexOutOfRange, buf);
                return;
        }

        snprintf(buf, 64, "Analog Input %d (Module: %d)", channel, moduleNumber);
        if (channels->Allocate((moduleNumber - 1) * kAnalogChannels + channel - 1, buf) == ~0ul)
        {
                CloneError(channels);
                return;
        }
        m_channel = channel;
        m_module = AnalogModule::GetInstance(moduleNumber);
        if (IsAccumulatorChannel())
        {
                tRioStatusCode localStatus = NiFpga_Status_Success;
                m_accumulator = tAccumulator::create(channel - 1, &localStatus);
                wpi_setError(localStatus);
                m_accumulatorOffset=0;
        }
        else
        {
                m_accumulator = NULL;
        }
}

AnalogChannel::AnalogChannel(UINT8 moduleNumber, UINT32 channel)
{
        InitChannel(moduleNumber, channel);
}

AnalogChannel::AnalogChannel(UINT32 channel)
{
        InitChannel(GetDefaultAnalogModule(), channel);
}

AnalogChannel::~AnalogChannel()
{
        channels->Free((m_module->GetNumber() - 1) * kAnalogChannels + m_channel - 1);
}

AnalogModule *AnalogChannel::GetModule()
{
        if (StatusIsFatal()) return NULL;
        return m_module;
}

INT16 AnalogChannel::GetValue()
{
        if (StatusIsFatal()) return 0;
        return m_module->GetValue(m_channel);
}

INT32 AnalogChannel::GetAverageValue()
{
        if (StatusIsFatal()) return 0;
        return m_module->GetAverageValue(m_channel);
}

float AnalogChannel::GetVoltage()
{
        if (StatusIsFatal()) return 0.0f;
        return m_module->GetVoltage(m_channel);
}

float AnalogChannel::GetAverageVoltage()
{
        if (StatusIsFatal()) return 0.0f;
        return m_module->GetAverageVoltage(m_channel);
}

UINT32 AnalogChannel::GetLSBWeight()
{
        if (StatusIsFatal()) return 0;
        return m_module->GetLSBWeight(m_channel);
}

INT32 AnalogChannel::GetOffset()
{
        if (StatusIsFatal()) return 0;
        return m_module->GetOffset(m_channel);
}

UINT32 AnalogChannel::GetChannel()
{
        if (StatusIsFatal()) return 0;
        return m_channel;
}

UINT8 AnalogChannel::GetModuleNumber()
{
        if (StatusIsFatal()) return 0;
        return m_module->GetNumber();
}

void AnalogChannel::SetAverageBits(UINT32 bits)
{
        if (StatusIsFatal()) return;
        m_module->SetAverageBits(m_channel, bits);
}

UINT32 AnalogChannel::GetAverageBits()
{
        if (StatusIsFatal()) return 0;
        return m_module->GetAverageBits(m_channel);
}

void AnalogChannel::SetOversampleBits(UINT32 bits)
{
        if (StatusIsFatal()) return;
        m_module->SetOversampleBits(m_channel, bits);
}

UINT32 AnalogChannel::GetOversampleBits()
{
        if (StatusIsFatal()) return 0;
        return m_module->GetOversampleBits(m_channel);
}

bool AnalogChannel::IsAccumulatorChannel()
{
        if (StatusIsFatal()) return false;
        if(m_module->GetNumber() != kAccumulatorModuleNumber) return false;
        for (UINT32 i=0; i<kAccumulatorNumChannels; i++)
        {
                if (m_channel == kAccumulatorChannels[i]) return true;
        }
        return false;
}

void AnalogChannel::InitAccumulator()
{
        if (StatusIsFatal()) return;
        m_accumulatorOffset = 0;
        SetAccumulatorCenter(0);
        ResetAccumulator();
}


void AnalogChannel::SetAccumulatorInitialValue(INT64 initialValue)
{
        if (StatusIsFatal()) return;
        m_accumulatorOffset = initialValue;
}

void AnalogChannel::ResetAccumulator()
{
        if (StatusIsFatal()) return;
        if (m_accumulator == NULL)
        {
                wpi_setWPIError(NullParameter);
                return;
        }
        tRioStatusCode localStatus = NiFpga_Status_Success;
        m_accumulator->strobeReset(&localStatus);
        wpi_setError(localStatus);
}

void AnalogChannel::SetAccumulatorCenter(INT32 center)
{
        if (StatusIsFatal()) return;
        if (m_accumulator == NULL)
        {
                wpi_setWPIError(NullParameter);
                return;
        }
        tRioStatusCode localStatus = NiFpga_Status_Success;
        m_accumulator->writeCenter(center, &localStatus);
        wpi_setError(localStatus);
}

void AnalogChannel::SetAccumulatorDeadband(INT32 deadband)
{
        if (StatusIsFatal()) return;
        if (m_accumulator == NULL)
        {
                wpi_setWPIError(NullParameter);
                return;
        }
        tRioStatusCode localStatus = NiFpga_Status_Success;
        m_accumulator->writeDeadband(deadband, &localStatus);
        wpi_setError(localStatus);
}

INT64 AnalogChannel::GetAccumulatorValue()
{
        if (StatusIsFatal()) return 0;
        if (m_accumulator == NULL)
        {
                wpi_setWPIError(NullParameter);
                return 0;
        }
        tRioStatusCode localStatus = NiFpga_Status_Success;
        INT64 value = m_accumulator->readOutput_Value(&localStatus) + m_accumulatorOffset;
        wpi_setError(localStatus);
        return value;
}

UINT32 AnalogChannel::GetAccumulatorCount()
{
        if (StatusIsFatal()) return 0;
        if (m_accumulator == NULL)
        {
                wpi_setWPIError(NullParameter);
                return 0;
        }
        tRioStatusCode localStatus = NiFpga_Status_Success;
        UINT32 count = m_accumulator->readOutput_Count(&localStatus);
        wpi_setError(localStatus);
        return count;
}


void AnalogChannel::GetAccumulatorOutput(INT64 *value, UINT32 *count)
{
        if (StatusIsFatal()) return;
        if (m_accumulator == NULL)
        {
                wpi_setWPIError(NullParameter);
                return;
        }
        if (value == NULL || count == NULL)
        {
                wpi_setWPIError(NullParameter);
                return;
        }

        tRioStatusCode localStatus = NiFpga_Status_Success;
        tAccumulator::tOutput output = m_accumulator->readOutput(&localStatus);
        *value = output.Value + m_accumulatorOffset;
        *count = output.Count;
        wpi_setError(localStatus);
}

double AnalogChannel::PIDGet() 
{
        if (StatusIsFatal()) return 0.0;
        return GetAverageValue();
}