Organized @TeleOp's into proper groups

TeamCode/src/main/java/dev/cyberarm/drivers/EncoderCustomKB2040.java

@@ -0,0 +1,67 @@
+package dev.cyberarm.drivers;
+
+import com.qualcomm.robotcore.hardware.I2cAddr;
+import com.qualcomm.robotcore.hardware.I2cDeviceSynchDevice;
+import com.qualcomm.robotcore.hardware.I2cDeviceSynchSimple;
+import com.qualcomm.robotcore.hardware.I2cWaitControl;
+import com.qualcomm.robotcore.hardware.configuration.annotations.DeviceProperties;
+import com.qualcomm.robotcore.hardware.configuration.annotations.I2cDeviceType;
+
+import java.nio.ByteBuffer;
+import java.nio.ByteOrder;
+
+@I2cDeviceType()
+@DeviceProperties(name = "Encoder Custom KB2040", description = "Non-competition legal i2c encoder", xmlTag = "ENCODER_CUSTOM_KB2040")
+public class EncoderCustomKB2040 extends I2cDeviceSynchDevice<I2cDeviceSynchSimple> {
+    enum Register {
+        REPORT_POSITION,
+        RESET_POSITION
+    }
+
+    private final static I2cAddr ADDRESS_I2C_DEFAULT = I2cAddr.create7bit(0x16);
+    private int position = -1;
+    public EncoderCustomKB2040(I2cDeviceSynchSimple i2cDeviceSynchSimple, boolean deviceClientIsOwned) {
+        super(i2cDeviceSynchSimple, deviceClientIsOwned);
+
+        this.deviceClient.setI2cAddress(ADDRESS_I2C_DEFAULT);
+        super.registerArmingStateCallback(false);
+        engage();
+    }
+
+    @Override
+    protected synchronized boolean doInitialize() {
+        return true;
+    }
+
+    @Override
+    public Manufacturer getManufacturer() {
+        return Manufacturer.Other;
+    }
+
+    @Override
+    public String getDeviceName() {
+        return "Encoder Custom KB2040";
+    }
+
+    public int getCurrentPosition() {
+//        deviceClient.write8(Register.READ.ordinal());
+
+        // Read int32_t
+        byte[] buffer = deviceClient.read(Register.REPORT_POSITION.ordinal(), 4);
+
+        // Reconstruct int32_t from 4 int8_t
+        int newPos = ByteBuffer.wrap(buffer).order(ByteOrder.BIG_ENDIAN).getInt();
+
+        position = newPos;
+
+        return position;
+    }
+
+    public int getLastPosition() {
+        return position;
+    }
+
+    public void reset() {
+        deviceClient.write8(Register.RESET_POSITION.ordinal(), I2cWaitControl.WRITTEN);
+    }
+}

TeamCode/src/main/java/dev/cyberarm/testing/CustomEncoderTestEngine.java

@@ -0,0 +1,40 @@
+package dev.cyberarm.testing;
+
+import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
+
+import dev.cyberarm.drivers.EncoderCustomKB2040;
+import dev.cyberarm.engine.V2.CyberarmEngine;
+import dev.cyberarm.engine.V2.CyberarmState;
+
+//@TeleOp(name = "I2C Driver Test", group = "TESTING")
+public class CustomEncoderTestEngine extends CyberarmEngine {
+    @Override
+    public void setup() {
+        addState(new CyberarmState() {
+            private EncoderCustomKB2040 encoder;
+            private double triggerMS = 0;
+            private int position = -1;
+
+            public void init() {
+                encoder = engine.hardwareMap.get(EncoderCustomKB2040.class, "encoder");
+            }
+
+            @Override
+            public void exec() {
+                if (runTime() - triggerMS >= 0) {
+                    triggerMS = runTime();
+
+                    position = encoder.getCurrentPosition();
+//                    encoder.reset();
+                }
+            }
+
+            @Override
+            public void telemetry() {
+                engine.telemetry.addData("POS", position);
+                engine.telemetry.addData("RunTime", runTime());
+                engine.telemetry.addData("Trigger", triggerMS);
+            }
+        });
+    }
+}

TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/ArmPosTestEngine.java

@@ -9,7 +9,7 @@ import org.timecrafters.CenterStage.TeleOp.States.YellowMinibotTeleOP;
 
 import dev.cyberarm.engine.V2.CyberarmEngine;
 
-@TeleOp(name = "arm test prototype bot")
+@TeleOp(name = "arm test prototype bot", group = "PROTOTYPE")
 
     public class ArmPosTestEngine extends CyberarmEngine {
     private PrototypeRobot robot;

TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/CompetitionRobotV1Engine.java

@@ -7,7 +7,7 @@ import org.timecrafters.CenterStage.TeleOp.States.CompetitionTeleOpState;
 
 import dev.cyberarm.engine.V2.CyberarmEngine;
 
-@TeleOp(name = "Competition V1 TeleOp", group = "Competition V1")
+@TeleOp(name = "Competition V1 TeleOp", group = "0 Competition V1")
 public class CompetitionRobotV1Engine extends CyberarmEngine {
     private CompetitionRobotV1 robot;
     @Override

TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/DriveMotorPortTestEngine.java

@@ -10,7 +10,7 @@ import org.timecrafters.CenterStage.TeleOp.TestingState.MotorPortTestingState;
 
 import dev.cyberarm.engine.V2.CyberarmEngine;
 
-@TeleOp (name = "Motor Port Test")
+@TeleOp (name = "Motor Port Test", group = "PROTOTYPE")
 public class DriveMotorPortTestEngine extends CyberarmEngine {
 
     MotorPortTestRobot robot;

TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/MiniBTeleOPEngine.java

@@ -7,7 +7,7 @@ import org.timecrafters.CenterStage.TeleOp.States.BlackMiniTeleOP;
 
 import dev.cyberarm.engine.V2.CyberarmEngine;
 
-@TeleOp(name = "Black Minibot")
+@TeleOp(name = "Black Minibot", group = "MINIBOT_SODI")
 
 public class MiniBTeleOPEngine extends CyberarmEngine {
     private MiniBTeleOPBot robot;

TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/MiniYTeleOPEngine.java

@@ -8,7 +8,7 @@ import org.timecrafters.CenterStage.TeleOp.States.YellowMinibotTeleOP;
 
 import dev.cyberarm.engine.V2.CyberarmEngine;
 
-@TeleOp(name = "A Yellow Minibot")
+@TeleOp(name = "A Yellow Minibot", group = "MINIBOT_SODI")
 
     public class MiniYTeleOPEngine extends CyberarmEngine {
     private MiniYTeleOPBot robot;

TeamCode/src/main/java/org/timecrafters/CenterStage/TeleOp/Engines/SodiPizzaTeleOPEngine.java

@@ -6,7 +6,7 @@ import org.timecrafters.CenterStage.TeleOp.States.SodiPizzaTeleOPState;
 
 import dev.cyberarm.engine.V2.CyberarmEngine;
 
-@TeleOp(name = "Sodi Pizza Box Bot TeleOP", group = "")
+@TeleOp(name = "Sodi Pizza Box Bot TeleOP", group = "MINIBOT_SODI")
 public class SodiPizzaTeleOPEngine extends CyberarmEngine {
     @Override
     public void setup() {