diff --git a/.idea/misc.xml b/.idea/misc.xml index d5d35ec..5c9f89f 100644 --- a/.idea/misc.xml +++ b/.idea/misc.xml @@ -1,6 +1,7 @@ - + + diff --git a/TeamCode/src/main/java/org/timecrafters/javaClass/aubrey/dance.java b/TeamCode/src/main/java/org/timecrafters/javaClass/aubrey/dance.java index abd84e3..30a42a9 100644 --- a/TeamCode/src/main/java/org/timecrafters/javaClass/aubrey/dance.java +++ b/TeamCode/src/main/java/org/timecrafters/javaClass/aubrey/dance.java @@ -17,16 +17,20 @@ public class dance extends CyberarmState { @Override public void exec() { float rotation = robot.getIMURotation(); - if (rotation = 0.5); + if (rightTriggerB) { + robot.collectionMotor.setPower(1); + } else { + robot.collectionMotor.setPower(0); + + } + + if (engine.gamepad1.b) { + robot.ringBeltMotor.setPower(-0.5); + } + /*left trigger ... when left trigger is held tracks moves ring, when trigger is let go track stops*/ + + if (leftTrigger >= 0.5) { + robot.ringBeltMotor.setPower(1); + } else { + robot.ringBeltMotor.setPower(0); + } + + if (robot.launchMotor.getPower() == 1) { + robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.RED); + } else if (leftTrigger >= 0.5) { + robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.BLUE); + } else if (rightTriggerB) { + robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.GOLD); + } else if (drivepower == 0.5){ + robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.ORANGE); + } else { + robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.GREEN); + } } - - if (b){ - robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.GREEN); - robot.driveFrontLeft.setPower(-1); - robot.driveFrontRight.setPower(-1); - robot.driveBackLeft.setPower(-1); - robot.driveBackRight.setPower(-1); - } - */ - - /*this is left bumper section... strafe to the left*/ - if (leftBumper) { - robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.GREEN); - robot.driveFrontLeft.setPower(-1); - robot.driveFrontRight.setPower(1); - robot.driveBackLeft.setPower(1); - robot.driveBackRight.setPower(-1); - } - - /* right bumper section ... strafe to the right*/ - else if (rightBumper) { - robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.GREEN); - robot.driveFrontLeft.setPower(1); - robot.driveFrontRight.setPower(-1); - robot.driveBackLeft.setPower(-1); - robot.driveBackRight.setPower(1); - } - - /* y section ... when y is pressed fly wheel starts, when a is pressed fly wheel stops*/ - if (y) { - robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.RED); - robot.launchMotor.setPower(1); - } else if (a) { - robot.launchMotor.setPower(0); - robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.GREEN); - } - - /*right Trigger section ... when right trigger is held collection wheels suck rings*/ - - if (rightTrigger>=0.5){ - robot.collectionMotor.setPower(1); - robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.BLUE); - } - /*left trigger ... when left trigger is held tracks moves ring, when trigger is let go track stops*/ - else if (leftTrigger>=0.5) { - robot.ringBeltMotor.setPower(1); - robot.ledDriver.setPattern(RevBlinkinLedDriver.BlinkinPattern.GOLD); - } - } }