Re-Re-Re-added Intake controls with new formatting with

the correct base branch and correct motor controls.
Updated Readme.md

Author: ngarnsworthy

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Constants.java

@@ -10,6 +10,12 @@ public static class Drivetrain {
 
     public static class Shooter {
         public static final String shooterMotorName = "shooterMotor";
+        public static final String rampMotorName = "rampMotor";
         public static final double defaultSpeed = 1;
     }
+
+    public static class Intake {
+        public static final String intakeMotorName = "intakeMotor";
+        public static final double defaultSpeed = 0.5;
+    }
 }

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/OpModes/BackupOpMode.java

@@ -34,7 +34,7 @@ public void initialize() {
         drivetrain.setDefaultCommand(new UserDrive(drivetrain, driverOp));
         register(drivetrain);
 
-        shooter = new Shooter(hardwareMap, Constants.Shooter.shooterMotorName);
+        shooter = new Shooter(hardwareMap, Constants.Shooter.shooterMotorName, Constants.Shooter.rampMotorName);
         register(shooter);
         coOp.getGamepadButton(GamepadKeys.Button.A).whileHeld(
                 new RunShooter(shooter, Constants.Shooter.defaultSpeed));

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/OpModes/PrimaryOpMode.java

@@ -6,14 +6,17 @@
 import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
 
 import org.firstinspires.ftc.teamcode.Constants;
+import org.firstinspires.ftc.teamcode.commands.RunIntake;
 import org.firstinspires.ftc.teamcode.commands.RunShooter;
 import org.firstinspires.ftc.teamcode.commands.UserDrive;
 import org.firstinspires.ftc.teamcode.subsystems.Drivetrain;
+import org.firstinspires.ftc.teamcode.subsystems.Intake;
 import org.firstinspires.ftc.teamcode.subsystems.Shooter;
 
 @TeleOp(name = "PrimaryOpMode", group = "NormalOpModes")
 public class PrimaryOpMode extends CommandOpMode {
     private Shooter shooter;
+    private Intake intake;
     private Drivetrain drivetrain;
 
     private GamepadEx driverOp;
@@ -33,9 +36,13 @@ public void initialize() {
         );
         drivetrain.setDefaultCommand(new UserDrive(drivetrain, driverOp));
         register(drivetrain);
-        shooter = new Shooter(hardwareMap, Constants.Shooter.shooterMotorName);
+        shooter = new Shooter(hardwareMap, Constants.Shooter.shooterMotorName, Constants.Shooter.rampMotorName);
         register(shooter);
+        intake = new Intake(hardwareMap, Constants.Intake.intakeMotorName);
+        register(intake);
         coOp.getGamepadButton(GamepadKeys.Button.A).whileHeld(
                 new RunShooter(shooter, Constants.Shooter.defaultSpeed));
+        coOp.getGamepadButton(GamepadKeys.Button.B).whileHeld(
+                new RunIntake(intake, Constants.Intake.defaultSpeed));
     }
 }

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/commands/RunIntake.java

@@ -0,0 +1,27 @@
+package org.firstinspires.ftc.teamcode.commands;
+
+import com.arcrobotics.ftclib.command.CommandBase;
+
+import org.firstinspires.ftc.teamcode.subsystems.Intake;
+
+public class RunIntake extends CommandBase {
+    private final Intake subsystem;
+
+    private final double speed;
+
+    public RunIntake(Intake _subsystem, double _speed) {
+        subsystem = _subsystem;
+        addRequirements(subsystem);
+        speed = _speed;
+    }
+
+    @Override
+    public void initialize() {
+        subsystem.run(speed);
+    }
+
+    @Override
+    public void end(boolean interrupted) {
+        subsystem.stop();
+    }
+}

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/readme.md

@@ -42,4 +42,13 @@ Subsystem that runs launcher
 ### Commands
 
 - RunShooter
-  - Runs shooter motors in raw mode with the specified power
+  - Runs shooter motors and ramp motors in raw mode with the specified power
+
+## Intake
+
+Subsystem that runs intake
+
+### Commands
+
+- RunIntake
+  - Runs intake motor in raw mode with the specified power

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystems/Intake.java

@@ -0,0 +1,23 @@
+package org.firstinspires.ftc.teamcode.subsystems;
+
+import com.arcrobotics.ftclib.command.SubsystemBase;
+import com.arcrobotics.ftclib.hardware.motors.Motor;
+import com.qualcomm.robotcore.hardware.HardwareMap;
+
+public class Intake extends SubsystemBase {
+    private final Motor intakeMotor;
+
+    public Intake(HardwareMap map, String intakeMotorName) {
+        intakeMotor = new Motor(map, intakeMotorName);
+        intakeMotor.setRunMode(Motor.RunMode.RawPower);
+    }
+
+    public void run(double speed) {
+        double clampedSpeed = Math.max(1.0, Math.min(-1.0, speed));
+        intakeMotor.set(clampedSpeed);
+    }
+
+    public void stop() {
+        intakeMotor.stopMotor();
+    }
+}

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystems/Shooter.java

@@ -5,20 +5,24 @@
 import com.qualcomm.robotcore.hardware.HardwareMap;
 
 public class Shooter extends SubsystemBase {
-    private final Motor shooterMotor;
+    private final Motor shooterMotor, rampMotor;
 
-    public Shooter(HardwareMap map, String motorName) {
-        shooterMotor = new Motor(map, motorName);
+    public Shooter(HardwareMap map, String shooterMotorName, String rampMotorName) {
+        shooterMotor = new Motor(map, shooterMotorName);
         shooterMotor.setRunMode(Motor.RunMode.RawPower);
+        rampMotor = new Motor(map, rampMotorName);
+        rampMotor.setRunMode(Motor.RunMode.RawPower);
     }
 
     public void run(double speed) {
         // Clamp speed to valid motor range [-1.0, 1.0]
         double clampedSpeed = Math.max(-1.0, Math.min(1.0, speed));
         shooterMotor.set(clampedSpeed);
+        rampMotor.set(clampedSpeed);
     }
 
     public void stop() {
         shooterMotor.stopMotor();
+        rampMotor.stopMotor();
     }
 }