manual testing controls

.SysId/sysid.json

@@ -0,0 +1 @@
+{}

src/main/java/frc/robot/RobotContainer.java

@@ -132,9 +132,11 @@ public class RobotContainer {
             )
         );
 
-        intake.setDefaultCommand(intake.intakeUpCommand());
+        //intake.setDefaultCommand(intake.intakeUpCommand());
+        intake.setDefaultCommand(intake.manualPivot(operator::getLeftY));
 
-        shooter.setDefaultCommand(shooter.angleSpeedsSetpoints(ShooterConstants.kShooterLoadAngle, 0.0, 0.0));
+       // shooter.setDefaultCommand(shooter.angleSpeedsSetpoints(ShooterConstants.kShooterLoadAngle, 0.0, 0.0));
+       shooter.setDefaultCommand(shooter.manualPivot(operator::getRightY);
 
         climber.setDefaultCommand(climber.stop());
 

src/main/java/frc/robot/constants/IntakeConstants.java

@@ -1,8 +1,8 @@
 package frc.robot.constants;
 
 public class IntakeConstants {
-    public static final int kIntakePivotID = 9;
-    public static final int kIntakeRollerID = 10;
+    public static final int kIntakePivotID = 10;
+    public static final int kIntakeRollerID = 12;
 
     public static final double kIntakePivotConversionFactor = 1/(20.0*(28.0/15.0));
 

src/main/java/frc/robot/subsystems/Intake.java

@@ -1,5 +1,7 @@
 package frc.robot.subsystems;
 
+import java.util.function.DoubleSupplier;
+
 import com.revrobotics.CANSparkMax;
 import com.revrobotics.RelativeEncoder;
 import com.revrobotics.CANSparkBase.IdleMode;
@@ -68,6 +70,12 @@ public class Intake extends SubsystemBase{
         });
     }
 
+    public Command manualPivot(DoubleSupplier pivotPower){
+        return run(() ->{
+            intakePivot.set(pivotPower.getAsDouble());
+        });
+    }
+
     public Command climbingStateCommand() {
         return run(() -> {
             intakeRoller.set(0.0);

src/main/java/frc/robot/subsystems/Shooter.java

@@ -131,4 +131,11 @@ public class Shooter extends SubsystemBase{
     public DoubleSupplier getShooterAngle(){
         return () -> {return pivotEncoder.getDistance();};
     }
+
+    public Command manualPivot(DoubleSupplier pivotPower){
+        return run(() ->{
+            shooterPivot.set(pivotPower.getAsDouble());
+        });
+    }
+
 }