diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/ColorSensorTester.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tests/ColorSensorTester.java similarity index 96% rename from TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/ColorSensorTester.java rename to TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tests/ColorSensorTester.java index 0054573..23efa1d 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/ColorSensorTester.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tests/ColorSensorTester.java @@ -1,4 +1,4 @@ -package org.firstinspires.ftc.teamcode.utils; +package org.firstinspires.ftc.teamcode.tests; import com.acmerobotics.dashboard.FtcDashboard; diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tests/LimelightTest.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tests/LimelightTest.java new file mode 100644 index 0000000..26e1cb1 --- /dev/null +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/tests/LimelightTest.java @@ -0,0 +1,57 @@ +package org.firstinspires.ftc.teamcode.tests; + +import com.acmerobotics.dashboard.FtcDashboard; +import com.acmerobotics.dashboard.config.Config; +import com.acmerobotics.dashboard.telemetry.MultipleTelemetry; +import com.qualcomm.robotcore.eventloop.opmode.Autonomous; +import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode; + +import org.firstinspires.ftc.teamcode.utils.Robot; +import org.firstinspires.ftc.teamcode.utils.subsystems.Limelight; + + +@Autonomous +@Config + +public class LimelightTest extends LinearOpMode { + + public static String MODE = "AT"; + public static int pipe = 1; + + + MultipleTelemetry TELE; + + Robot robot; + + @Override + public void runOpMode() throws InterruptedException { + + + robot = new Robot(hardwareMap); + + TELE = new MultipleTelemetry(telemetry, FtcDashboard.getInstance().getTelemetry()); + + Limelight limelight = new Limelight(robot, TELE); + + limelight.setMode(MODE); + + limelight.setTelemetryOn(true); + + waitForStart(); + + if(isStopRequested()) return; + + while(opModeIsActive()){ + + limelight.setPipeline(pipe); + + limelight.setMode(MODE); + + limelight.update(); + + TELE.update(); + + } + + } +} diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Vars.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Vars.java new file mode 100644 index 0000000..e28deec --- /dev/null +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/Vars.java @@ -0,0 +1,10 @@ +package org.firstinspires.ftc.teamcode.utils; + + +import com.acmerobotics.dashboard.config.Config; + +@Config +public class Vars { + + public static boolean USING_LL = false; +} diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/functions/DistanceToTarget.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/functions/DistanceToTarget.java new file mode 100644 index 0000000..326ca4a --- /dev/null +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/utils/functions/DistanceToTarget.java @@ -0,0 +1,4 @@ +package org.firstinspires.ftc.teamcode.utils.functions; + +public class DistanceToTarget { +}