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("force hood down", new InstantCommand(() -> forceHoodDown(true)));
+ SmartDashboard.putData("unforce hood", new InstantCommand(() -> forceHoodDown(false)));
+ }
/**
* @return Position of the MOTOR in radians