SmartDashboard.putData("max", new InstantCommand(() -> setFieldRelativeTarget(new Rotation2d(Units.degreesToRadians(HoodConstants.MAX_ANGLE)), 0)));
SmartDashboard.putData("medium", new InstantCommand(() -> setFieldRelativeTarget(new Rotation2d(Units.degreesToRadians((HoodConstants.MAX_ANGLE + HoodConstants.MIN_ANGLE) / 2)), 0)));
SmartDashboard.putData("min", new InstantCommand(() -> setFieldRelativeTarget(new Rotation2d(Units.degreesToRadians(HoodConstants.MIN_ANGLE)), 0)));
-
- SmartDashboard.putData("Hood Calibrate", new InstantCommand(() -> calibrate()));
- SmartDashboard.putData("Hood Stop Calibrating", new InstantCommand(() -> stopCalibrating()));
- SmartDashboard.putData("force hood down", new InstantCommand(() -> forceHoodDown(true)));
- SmartDashboard.putData("unforce hood", new InstantCommand(() -> forceHoodDown(false)));
- }
+ }
/**
* @return Position of the MOTOR in radians