小改
This commit is contained in:
@@ -17,44 +17,27 @@ import frc.robot.Constants;
|
||||
*/
|
||||
public class ConveyorSubsystem extends SubsystemBase {
|
||||
public final TalonFX mainConveyor;
|
||||
|
||||
private final VoltageOut voltageRequest = new VoltageOut(0);
|
||||
private final NetworkTable table = NetworkTableInstance.getDefault().getTable("Conveyor");
|
||||
|
||||
private double voltage = 0.0;
|
||||
|
||||
public ConveyorSubsystem() {
|
||||
mainConveyor = new TalonFX(Constants.Conveyor.mainConveyorID);
|
||||
}
|
||||
|
||||
public void feedToShooter() {
|
||||
setVoltage(Constants.Conveyor.feedVoltage);
|
||||
}
|
||||
|
||||
public void reverse() {
|
||||
setVoltage(Constants.Conveyor.reverseVoltage);
|
||||
}
|
||||
|
||||
public void hold() {
|
||||
setVoltage(Constants.Conveyor.holdVoltage);
|
||||
}
|
||||
|
||||
public void stop() {
|
||||
setVoltage(0.0);
|
||||
}
|
||||
|
||||
public void setPercent(double percent) {
|
||||
setVoltage(percent * 12.0);
|
||||
}
|
||||
|
||||
public void setVoltage(double volts) {
|
||||
voltage = MathUtil.clamp(volts, -12.0, 12.0);
|
||||
mainConveyor.setControl(voltageRequest.withOutput(voltage));
|
||||
mainConveyor.setControl(voltageRequest.withOutput(volts));
|
||||
}
|
||||
|
||||
|
||||
@Override
|
||||
public void periodic() {
|
||||
table.getEntry("voltage").setDouble(voltage);
|
||||
table.getEntry("velocity").setDouble(mainConveyor.getVelocity().getValueAsDouble());
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user