public abstract class PIDSubsystem extends Subsystem implements Sendable
Subsystem
which uses a single PIDController
almost constantly (for instance,
an elevator which attempts to stay at a constant height).
It provides some convenience methods to run an internal PIDController
.
It also allows access to the internal PIDController
in order to give total control
to the programmer.
Constructor and Description |
---|
PIDSubsystem(double p,
double i,
double d)
Instantiates a
PIDSubsystem that will use the given p, i and d values. |
PIDSubsystem(double p,
double i,
double d,
double period)
Instantiates a
PIDSubsystem that will use the given p, i and d values. |
PIDSubsystem(double p,
double i,
double d,
double period,
double f)
Instantiates a
PIDSubsystem that will use the given p, i and d values. |
PIDSubsystem(String name,
double p,
double i,
double d)
Instantiates a
PIDSubsystem that will use the given p, i and d values. |
PIDSubsystem(String name,
double p,
double i,
double d,
double f)
Instantiates a
PIDSubsystem that will use the given p, i and d values. |
PIDSubsystem(String name,
double p,
double i,
double d,
double f,
double period)
Instantiates a
PIDSubsystem that will use the given p, i and d values. |
Modifier and Type | Method and Description |
---|---|
void |
disable()
Disables the internal
PIDController |
void |
enable()
Enables the internal
PIDController |
PIDController |
getPIDController()
Returns the
PIDController used by this PIDSubsystem . |
double |
getPosition()
Returns the current position
|
double |
getSetpoint()
Returns the setpoint.
|
String |
getSmartDashboardType() |
void |
initTable(edu.wpi.first.wpilibj.tables.ITable table)
Initializes a table for this sendable object.
|
boolean |
onTarget()
Return true if the error is within the percentage of the total input range,
determined by setTolerance.
|
protected abstract double |
returnPIDInput()
Returns the input for the pid loop.
|
void |
setAbsoluteTolerance(double t)
Set the absolute error which is considered tolerable for use with
OnTarget.
|
void |
setInputRange(double minimumInput,
double maximumInput)
Sets the maximum and minimum values expected from the input.
|
void |
setOutputRange(double minimumOutput,
double maximumOutput)
Sets the maximum and minimum values to write.
|
void |
setPercentTolerance(double p)
Set the percentage error which is considered tolerable for use with
OnTarget.
|
void |
setSetpoint(double setpoint)
Sets the setpoint to the given value.
|
void |
setSetpointRelative(double deltaSetpoint)
Adds the given value to the setpoint.
|
protected abstract void |
usePIDOutput(double output)
Uses the value that the pid loop calculated.
|
getCurrentCommand, getDefaultCommand, getName, getTable, initDefaultCommand, setDefaultCommand, toString
public PIDSubsystem(String name, double p, double i, double d)
PIDSubsystem
that will use the given p, i and d values.name
- the namep
- the proportional valuei
- the integral valued
- the derivative valuepublic PIDSubsystem(String name, double p, double i, double d, double f)
PIDSubsystem
that will use the given p, i and d values.name
- the namep
- the proportional valuei
- the integral valued
- the derivative valuef
- the feed forward valuepublic PIDSubsystem(String name, double p, double i, double d, double f, double period)
PIDSubsystem
that will use the given p, i and d values. It will also space the time
between PID loop calculations to be equal to the given period.name
- the namep
- the proportional valuei
- the integral valued
- the derivative valueperiod
- the time (in seconds) between calculationspublic PIDSubsystem(double p, double i, double d)
PIDSubsystem
that will use the given p, i and d values.
It will use the class name as its name.p
- the proportional valuei
- the integral valued
- the derivative valuepublic PIDSubsystem(double p, double i, double d, double period, double f)
PIDSubsystem
that will use the given p, i and d values.
It will use the class name as its name.
It will also space the time
between PID loop calculations to be equal to the given period.p
- the proportional valuei
- the integral valued
- the derivative valuef
- the feed forward coefficientperiod
- the time (in seconds) between calculationspublic PIDSubsystem(double p, double i, double d, double period)
PIDSubsystem
that will use the given p, i and d values.
It will use the class name as its name.
It will also space the time
between PID loop calculations to be equal to the given period.p
- the proportional valuei
- the integral valued
- the derivative valueperiod
- the time (in seconds) between calculationspublic PIDController getPIDController()
PIDController
used by this PIDSubsystem
.
Use this if you would like to fine tune the pid loop.PIDController
used by this PIDSubsystem
public void setSetpointRelative(double deltaSetpoint)
setInputRange(...)
was used,
then the bounds will still be honored by this method.deltaSetpoint
- the change in the setpointpublic void setSetpoint(double setpoint)
setInputRange(...)
was called,
then the given setpoint
will be trimmed to fit within the range.setpoint
- the new setpointpublic double getSetpoint()
public double getPosition()
public void setInputRange(double minimumInput, double maximumInput)
minimumInput
- the minimum value expected from the inputmaximumInput
- the maximum value expected from the outputpublic void setOutputRange(double minimumOutput, double maximumOutput)
minimumOutput
- the minimum value to write to the outputmaximumOutput
- the maximum value to write to the outputpublic void setAbsoluteTolerance(double t)
t
- the absolute tolerancepublic void setPercentTolerance(double p)
p
- the percent tolerancepublic boolean onTarget()
protected abstract double returnPIDInput()
It returns the input for the pid loop, so if this Subsystem was based off of a gyro, then it should return the angle of the gyro
All subclasses of PIDSubsystem
must override this method.
protected abstract void usePIDOutput(double output)
driveline.tankDrive(output, -output)
All subclasses of PIDSubsystem
must override this method.
output
- the value the pid loop calculatedpublic void enable()
PIDController
public void disable()
PIDController
public String getSmartDashboardType()
getSmartDashboardType
in interface Sendable
getSmartDashboardType
in class Subsystem
public void initTable(edu.wpi.first.wpilibj.tables.ITable table)
Sendable
Copyright © 2015. All rights reserved.