rejecter

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

@@ -0,0 +1,27 @@
+package org.firstinspires.ftc.teamcode.subsystems;
+
+
+import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
+import com.qualcomm.robotcore.hardware.Servo;
+
+import org.firstinspires.ftc.teamcode.utils.Robot;
+
+public class Rejecter implements Subsystem{
+
+    private final Servo servo;
+
+    public double rpos = 0.5;
+
+    public Rejecter(Robot robot){
+        this.servo = robot.rejecter;
+    }
+
+    public void rejecterPos(double pos){
+        this.rpos = pos;
+    }
+
+    @Override
+    public void update() {
+        this.servo.setPosition(rpos);
+    }
+}

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/teleop/TeleopV1.java

@@ -17,6 +17,7 @@ import org.firstinspires.ftc.robotcore.external.navigation.AngleUnit;
 import org.firstinspires.ftc.teamcode.libs.RR.MecanumDrive;
 import org.firstinspires.ftc.teamcode.subsystems.Drivetrain;
 import org.firstinspires.ftc.teamcode.subsystems.Intake;
+import org.firstinspires.ftc.teamcode.subsystems.Rejecter;
 import org.firstinspires.ftc.teamcode.subsystems.Shooter;
 import org.firstinspires.ftc.teamcode.subsystems.Spindexer;
 import org.firstinspires.ftc.teamcode.subsystems.Transfer;
@@ -28,6 +29,7 @@ import org.firstinspires.ftc.teamcode.utils.Robot;
 
 public class TeleopV1 extends LinearOpMode {
 
+    public static double rpos = 0.5;
 
     Robot robot;
 
@@ -35,6 +37,8 @@ public class TeleopV1 extends LinearOpMode {
 
     Intake intake;
 
+    Rejecter rejecter;
+
     Spindexer spindexer;
 
     Transfer transfer;
@@ -201,7 +205,6 @@ public class TeleopV1 extends LinearOpMode {
 
         transfer = new Transfer(robot);
 
-
         spindexer = new Spindexer(robot, TELE);
 
         spindexer.setTelemetryOn(true);
@@ -265,6 +268,8 @@ public class TeleopV1 extends LinearOpMode {
 
             intake();
 
+            rejecter.rejecterPos(rpos);
+
             drivetrain.update();
 
             TELE.update();