diff --git a/.idea/misc.xml b/.idea/misc.xml index 860da66..d5d35ec 100644 --- a/.idea/misc.xml +++ b/.idea/misc.xml @@ -1,6 +1,6 @@ - + diff --git a/TeamCode/src/main/java/org/timecrafters/javaClass/spencer/SpencerDriveFoward.java b/TeamCode/src/main/java/org/timecrafters/javaClass/spencer/SpencerDriveFoward.java new file mode 100644 index 0000000..973af18 --- /dev/null +++ b/TeamCode/src/main/java/org/timecrafters/javaClass/spencer/SpencerDriveFoward.java @@ -0,0 +1,21 @@ +package org.timecrafters.javaClass.spencer; + +import org.cyberarm.engine.V2.CyberarmState; +import org.timecrafters.javaClass.samples.SampleRobot; + +public class SpencerDriveFoward extends CyberarmState { + + + private SampleRobot robot; + + public SpencerDriveFoward(SampleRobot robot) { + this.robot = robot; + } + + @Override + public void exec() { + if () + + } + +} diff --git a/TeamCode/src/main/java/org/timecrafters/javaClass/spencer/SpencerFirstState.java b/TeamCode/src/main/java/org/timecrafters/javaClass/spencer/SpencerFirstState.java index b50d769..650b372 100644 --- a/TeamCode/src/main/java/org/timecrafters/javaClass/spencer/SpencerFirstState.java +++ b/TeamCode/src/main/java/org/timecrafters/javaClass/spencer/SpencerFirstState.java @@ -7,7 +7,10 @@ public class SpencerFirstState extends CyberarmState { //here, you'll find some of your variables. you can add more as you need them. private SampleRobot robot; - + private double rightStick; + private double leftStick; + private boolean leftBumper; + private boolean rightBumper; //This is the constructor. It lets other code bits run use the code you put here public SpencerFirstState(SampleRobot robot) { this.robot = robot; @@ -17,6 +20,27 @@ public class SpencerFirstState extends CyberarmState { //This one is set up to repeat every few milliseconds @Override public void exec() { + rightStick = engine.gamepad1.right_stick_y; + leftStick = engine.gamepad1.left_stick_y; + leftBumper = engine.gamepad1.left_bumper; + rightBumper = engine.gamepad1.right_bumper; + + robot.driveFrontLeft.setPower(-leftStick); + robot.driveFrontRight.setPower(-rightStick); + robot.driveBackLeft.setPower(-leftStick); + robot.driveBackRight.setPower(-rightStick); + if (leftBumper) { + robot.driveFrontLeft.setPower(-1); + robot.driveFrontRight.setPower(-1); + robot.driveBackLeft.setPower(-1); + robot.driveBackRight.setPower(-1); + } else if (rightBumper) { + robot.driveFrontLeft.setPower(1); + robot.driveFrontRight.setPower(1); + robot.driveBackLeft.setPower(1); + robot.driveBackRight.setPower(1); + } + } }