diff --git a/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/Engine.java b/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/Engine.java new file mode 100644 index 0000000..38f40e4 --- /dev/null +++ b/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/Engine.java @@ -0,0 +1,24 @@ +package org.timecrafters.minibots.cyberarm; + +import com.qualcomm.robotcore.eventloop.opmode.TeleOp; + +import org.cyberarm.engine.V2.CyberarmEngine; +import org.timecrafters.minibots.cyberarm.engines.Common; + +@TeleOp (name = "light test") + +public class Engine extends CyberarmEngine { + + Common robot; + + @Override + public void setup() { + + robot = new Common(this); + + addState(new State(robot)); + + + + } +} diff --git a/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/State.java b/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/State.java new file mode 100644 index 0000000..23038f1 --- /dev/null +++ b/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/State.java @@ -0,0 +1,63 @@ +package org.timecrafters.minibots.cyberarm; + +import com.qualcomm.hardware.rev.RevBlinkinLedDriver; + +import org.cyberarm.engine.V2.CyberarmState; +import org.timecrafters.minibots.cyberarm.engines.Common; + +public class State extends CyberarmState { + + private final Common robot; + + public State (Common robot) { this.robot = robot; } + + @Override + public void init() { + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.GREEN); + } + + @Override + public void exec() { + + if (engine.gamepad1.a) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.GREEN); + + } + else if (engine.gamepad1.dpad_up) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.CP1_LIGHT_CHASE); + + } + if (engine.gamepad1.x) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.BLUE); + + } + else if (engine.gamepad1.dpad_up) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.CP1_LIGHT_CHASE); + + } + if (engine.gamepad1.y) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.YELLOW); + + } + else if (engine.gamepad1.dpad_up) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.CP1_LIGHT_CHASE); + + } + if (engine.gamepad1.b) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.RED); + + } + else if (engine.gamepad1.dpad_up) { + + robot.leds.setPattern(RevBlinkinLedDriver.BlinkinPattern.CP1_LIGHT_CHASE); + + } + } +} diff --git a/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/engines/Common.java b/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/engines/Common.java new file mode 100644 index 0000000..744c2f9 --- /dev/null +++ b/TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/engines/Common.java @@ -0,0 +1,27 @@ +package org.timecrafters.minibots.cyberarm.engines; + +import com.qualcomm.hardware.rev.RevBlinkinLedDriver; + +import org.cyberarm.engine.V2.CyberarmEngine; + +public class Common { + + private CyberarmEngine engine; + + public RevBlinkinLedDriver leds; + + public Common (CyberarmEngine engine) { + + this.engine = engine; + + setupRobot (); + + } + + private void setupRobot () { + + leds = engine.hardwareMap.get(RevBlinkinLedDriver.class, "lights"); + + } + +}