diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Flywheel.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Flywheel.java index 30340a3..277cdff 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Flywheel.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Flywheel.java @@ -43,14 +43,13 @@ public class Flywheel { velo1a = 60 * ((currentPos1 - initPos1) / (stamp - stamp1)); velo1b = 60 * ((currentPos2 - initPos2) / (stamp - stamp1)); initPos1 = currentPos1; + initPos2 = currentPos2; stamp1 = stamp; - if (Math.abs(velo1a - velo1b) > 200) { - if (velo1a < 200) { - velo1 = velo1b; - } else { - velo1 = velo1a; - } + if (velo1a < 200){ + velo1 = velo1b; + } else if (velo1b < 200){ + velo1 = velo1a; } else { velo1 = (velo1a + velo1b) / 2; } diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Robot.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Robot.java index 88f5278..2562a9d 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Robot.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Robot.java @@ -35,8 +35,8 @@ public class Robot { shooter2 = hardwareMap.get(DcMotorEx.class, "s2"); shooter1.setDirection(DcMotorSimple.Direction.REVERSE); shooter2.setDirection(DcMotorSimple.Direction.REVERSE); - shooter1.setMode(DcMotor.RunMode.RUN_USING_ENCODER); - shooter2.setMode(DcMotor.RunMode.RUN_USING_ENCODER); + shooter1.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER); + shooter2.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER); hood = hardwareMap.get(Servo.class, "hood");