diff --git a/TeamCode/src/main/java/org/timecrafters/CenterStage/Autonomous/Engines/ProtoBotEngineSodi.java b/TeamCode/src/main/java/org/timecrafters/CenterStage/Autonomous/Engines/ProtoBotEngineSodi.java new file mode 100644 index 0000000..c440293 --- /dev/null +++ b/TeamCode/src/main/java/org/timecrafters/CenterStage/Autonomous/Engines/ProtoBotEngineSodi.java @@ -0,0 +1,20 @@ +package org.timecrafters.CenterStage.Autonomous.Engines; +import com.qualcomm.robotcore.eventloop.opmode.Autonomous; + +import org.timecrafters.CenterStage.Common.ProtoBotSodi; +import org.timecrafters.CenterStage.Autonomous.States.ProtoBotStateSodi; +import org.timecrafters.CenterStage.Autonomous.States.ProtoBotStateSodi; + +import dev.cyberarm.engine.V2.CyberarmEngine; + +@Autonomous(name = "Rigel", group = "Prototype Sodi") +public class ProtoBotEngineSodi extends CyberarmEngine { + private ProtoBotSodi robot; + @Override + public void setup() { + this.robot = new ProtoBotSodi(); + this.robot.setup(); + + addState(new ProtoBotStateSodi(robot)); + } +} diff --git a/TeamCode/src/main/java/org/timecrafters/CenterStage/Autonomous/States/ProtoBotStateSodi.java b/TeamCode/src/main/java/org/timecrafters/CenterStage/Autonomous/States/ProtoBotStateSodi.java new file mode 100644 index 0000000..b93e7d6 --- /dev/null +++ b/TeamCode/src/main/java/org/timecrafters/CenterStage/Autonomous/States/ProtoBotStateSodi.java @@ -0,0 +1,35 @@ +package org.timecrafters.CenterStage.Autonomous.States; + +import com.qualcomm.robotcore.hardware.DcMotor; +import com.qualcomm.robotcore.hardware.Servo; + +import dev.cyberarm.engine.V2.CyberarmState; +import org.timecrafters.CenterStage.Common.ProtoBotSodi; + + +public class ProtoBotStateSodi extends CyberarmState { + ProtoBotSodi robot; + public ProtoBotStateSodi(ProtoBotSodi robot) { + this.robot = robot; + } + public void telemetry() { + + } + @Override + public void start() { + + //Motors + robot.flDrive.motor.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER); + robot.frDrive.motor.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER); + robot.blDrive.motor.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER); + robot.brDrive.motor.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER); + robot.bloodWorm.motor.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER); + + //Servos + robot.jaw.setDirection(Servo.Direction.FORWARD); + } + @Override + public void exec() { + + } +} diff --git a/TeamCode/src/main/java/org/timecrafters/CenterStage/Common/ProtoBotSodi.java b/TeamCode/src/main/java/org/timecrafters/CenterStage/Common/ProtoBotSodi.java index 9b0855a..4d26d10 100644 --- a/TeamCode/src/main/java/org/timecrafters/CenterStage/Common/ProtoBotSodi.java +++ b/TeamCode/src/main/java/org/timecrafters/CenterStage/Common/ProtoBotSodi.java @@ -25,9 +25,14 @@ public class ProtoBotSodi extends Robot { public MotorEx flDrive, frDrive, blDrive, brDrive, bloodWorm; public CRServo fang; public Servo jaw; + + private TimeCraftersConfiguration configuration; + @Override public void setup() { + configuration = new TimeCraftersConfiguration("Rigel"); + //Motors flDrive = new MotorEx(hardwareMap, "FrontLeftDrive"); frDrive = new MotorEx(hardwareMap, "FrontRightDrive"); diff --git a/TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/ProtoBotEngineSodi.java b/TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/ProtoBotEngineSodi.java deleted file mode 100644 index a00ef0a..0000000 --- a/TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/ProtoBotEngineSodi.java +++ /dev/null @@ -1,10 +0,0 @@ -package org.timecrafters.CenterStage.TeleOp.Engines; - -import dev.cyberarm.engine.V2.CyberarmEngine; - -public class ProtoBotEngineSodi extends CyberarmEngine { - @Override - public void setup() { - - } -} diff --git a/TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/States/ProtoBotStateSodi.java b/TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/States/ProtoBotStateSodi.java deleted file mode 100644 index 4cfc12b..0000000 --- a/TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/States/ProtoBotStateSodi.java +++ /dev/null @@ -1,15 +0,0 @@ -package org.timecrafters.CenterStage.TeleOp.States; - -import dev.cyberarm.engine.V2.CyberarmState; -import org.timecrafters.CenterStage.Common.ProtoBotSodi; - - -public class ProtoBotStateSodi extends CyberarmState { - public void telemetry() { - - } - @Override - public void exec() { - - } -}