PIDSubsystem.h

/*----------------------------------------------------------------------------*/
/* Copyright (c) FIRST 2011. 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.  */
/*----------------------------------------------------------------------------*/

#ifndef __PID_SUBSYSTEM_H__
#define __PID_SUBSYSTEM_H__

#include "Commands/Subsystem.h"
#include "PIDController.h"
#include "PIDSource.h"
#include "PIDOutput.h"

class PIDSubsystem : public Subsystem, public PIDOutput, public PIDSource
{
public:
        PIDSubsystem(const char *name, double p, double i, double d);
        PIDSubsystem(const char *name, double p, double i, double d, double f);
        PIDSubsystem(const char *name, double p, double i, double d, double f, double period);
        PIDSubsystem(double p, double i, double d);
        PIDSubsystem(double p, double i, double d, double f);
        PIDSubsystem(double p, double i, double d, double f, double period);
        virtual ~PIDSubsystem();
        
        void Enable();
        void Disable();

        // PIDOutput interface
        virtual void PIDWrite(float output);

        // PIDSource interface
        virtual double PIDGet();
        void SetSetpoint(double setpoint);
        void SetSetpointRelative(double deltaSetpoint);
        void SetInputRange(float minimumInput, float maximumInput);
        double GetSetpoint();
        double GetPosition();

        virtual void SetAbsoluteTolerance(float absValue);
        virtual void SetPercentTolerance(float percent);
        virtual bool OnTarget();
        
protected:
        PIDController *GetPIDController();

        virtual double ReturnPIDInput() = 0;
        virtual void UsePIDOutput(double output) = 0;

private:
        PIDController *m_controller;

public:
        virtual void InitTable(ITable* table);
        virtual std::string GetSmartDashboardType();
};

#endif