Skip to content

Commit

Permalink
getvoltage
Browse files Browse the repository at this point in the history
  • Loading branch information
drorta committed Oct 1, 2024
1 parent d09a151 commit f3ff9a4
Showing 1 changed file with 8 additions and 8 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -25,22 +25,22 @@ public class RealFunnelConstants {


public static FunnelStuff generateFunnelStuff(String logPath) {
SparkMaxWrapper wrapper = new SparkMaxWrapper(IDs.CANSparkMAXIDs.FUNNEL);
SparkMaxWrapper sparkMAXWrapper = new SparkMaxWrapper(IDs.CANSparkMAXIDs.FUNNEL);
SysIdRoutine.Config config = new SysIdRoutine.Config();
BrushlessSparkMAXMotor motor = new BrushlessSparkMAXMotor(logPath, wrapper, config);
BrushlessSparkMAXMotor motor = new BrushlessSparkMAXMotor(logPath, sparkMAXWrapper, config);

Supplier<Double> voltage = () -> wrapper.getBusVoltage() * wrapper.getAppliedOutput();
Supplier<Double> voltage = sparkMAXWrapper::getVoltage;
SuppliedDoubleSignal voltageSignal = new SuppliedDoubleSignal("voltage", voltage);

Supplier<Double> position = () -> wrapper.getEncoder().getPosition();
Supplier<Double> position = () -> sparkMAXWrapper.getEncoder().getPosition();
SuppliedAngleSignal positionSignal = new SuppliedAngleSignal("position", position, AngleUnit.ROTATIONS);

BooleanSupplier isShooterBeamBroken = () -> wrapper.getReverseLimitSwitch(REVERSE_LIMIT_SWITCH_TYPE).isPressed();
wrapper.getReverseLimitSwitch(REVERSE_LIMIT_SWITCH_TYPE).enableLimitSwitch(false);
BooleanSupplier isShooterBeamBroken = () -> sparkMAXWrapper.getReverseLimitSwitch(REVERSE_LIMIT_SWITCH_TYPE).isPressed();
sparkMAXWrapper.getReverseLimitSwitch(REVERSE_LIMIT_SWITCH_TYPE).enableLimitSwitch(false);
SuppliedDigitalInput shooterBeamBreaker = new SuppliedDigitalInput(isShooterBeamBroken, DEBOUNCE_TYPE, DEBOUNCE_TIME_SECONDS);

BooleanSupplier isAmpBeamBroken = () -> wrapper.getForwardLimitSwitch(REVERSE_LIMIT_SWITCH_TYPE).isPressed();
wrapper.getForwardLimitSwitch(FORWARD_LIMIT_SWITCH_TYPE).enableLimitSwitch(false);
BooleanSupplier isAmpBeamBroken = () -> sparkMAXWrapper.getForwardLimitSwitch(REVERSE_LIMIT_SWITCH_TYPE).isPressed();
sparkMAXWrapper.getForwardLimitSwitch(FORWARD_LIMIT_SWITCH_TYPE).enableLimitSwitch(false);
SuppliedDigitalInput ampBeamBreaker = new SuppliedDigitalInput(isAmpBeamBroken, DEBOUNCE_TYPE, DEBOUNCE_TIME_SECONDS);

return new FunnelStuff(logPath, motor, voltageSignal, positionSignal, shooterBeamBreaker, ampBeamBreaker);
Expand Down

0 comments on commit f3ff9a4

Please sign in to comment.