mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-26 01:51:41 +00:00
75 lines
2.6 KiB
C++
75 lines
2.6 KiB
C++
/*----------------------------------------------------------------------------*/
|
|
/* Copyright (c) 2011-2018 FIRST. 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 the root directory of */
|
|
/* the project. */
|
|
/*----------------------------------------------------------------------------*/
|
|
|
|
#pragma once
|
|
|
|
#include <memory>
|
|
|
|
#include <wpi/Twine.h>
|
|
|
|
#include "frc/PIDController.h"
|
|
#include "frc/PIDOutput.h"
|
|
#include "frc/PIDSource.h"
|
|
#include "frc/commands/Command.h"
|
|
|
|
namespace frc {
|
|
|
|
class PIDCommand : public Command, public PIDOutput, public PIDSource {
|
|
public:
|
|
PIDCommand(const wpi::Twine& name, double p, double i, double d);
|
|
PIDCommand(const wpi::Twine& name, double p, double i, double d,
|
|
double period);
|
|
PIDCommand(const wpi::Twine& name, double p, double i, double d, double f,
|
|
double period);
|
|
PIDCommand(double p, double i, double d);
|
|
PIDCommand(double p, double i, double d, double period);
|
|
PIDCommand(double p, double i, double d, double f, double period);
|
|
PIDCommand(const wpi::Twine& name, double p, double i, double d,
|
|
Subsystem& subsystem);
|
|
PIDCommand(const wpi::Twine& name, double p, double i, double d,
|
|
double period, Subsystem& subsystem);
|
|
PIDCommand(const wpi::Twine& name, double p, double i, double d, double f,
|
|
double period, Subsystem& subsystem);
|
|
PIDCommand(double p, double i, double d, Subsystem& subsystem);
|
|
PIDCommand(double p, double i, double d, double period, Subsystem& subsystem);
|
|
PIDCommand(double p, double i, double d, double f, double period,
|
|
Subsystem& subsystem);
|
|
virtual ~PIDCommand() = default;
|
|
|
|
PIDCommand(PIDCommand&&) = default;
|
|
PIDCommand& operator=(PIDCommand&&) = default;
|
|
|
|
void SetSetpointRelative(double deltaSetpoint);
|
|
|
|
// PIDOutput interface
|
|
void PIDWrite(double output) override;
|
|
|
|
// PIDSource interface
|
|
double PIDGet() override;
|
|
|
|
protected:
|
|
std::shared_ptr<PIDController> GetPIDController() const;
|
|
void _Initialize() override;
|
|
void _Interrupted() override;
|
|
void _End() override;
|
|
void SetSetpoint(double setpoint);
|
|
double GetSetpoint() const;
|
|
double GetPosition();
|
|
|
|
virtual double ReturnPIDInput() = 0;
|
|
virtual void UsePIDOutput(double output) = 0;
|
|
|
|
private:
|
|
// The internal PIDController
|
|
std::shared_ptr<PIDController> m_controller;
|
|
|
|
public:
|
|
void InitSendable(SendableBuilder& builder) override;
|
|
};
|
|
|
|
} // namespace frc
|