From 353eb28aa638a66ad429073ac5c72d00abf00248 Mon Sep 17 00:00:00 2001
From: Spencer <SpencerPiha>
Date: Tue, 2 Nov 2021 20:07:54 -0500
Subject: [PATCH] (: servo

---
 .../Engines/ServoTestEngine.java              | 14 +++++++++++
 .../States/ServoTestState.java                | 23 +++++++++++++++++++
 2 files changed, 37 insertions(+)
 create mode 100644 TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/Engines/ServoTestEngine.java
 create mode 100644 TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/States/ServoTestState.java

diff --git a/TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/Engines/ServoTestEngine.java b/TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/Engines/ServoTestEngine.java
new file mode 100644
index 0000000..e815340
--- /dev/null
+++ b/TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/Engines/ServoTestEngine.java
@@ -0,0 +1,14 @@
+package org.timecrafters.FreightFrenzy.HardwareTesting.Engines;
+
+import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
+
+import org.cyberarm.engine.V2.CyberarmEngine;
+import org.timecrafters.FreightFrenzy.HardwareTesting.States.ISO8061State;
+
+@TeleOp(name = "Servo Test ", group = "testing")
+public class ServoTestEngine extends CyberarmEngine {
+    @Override
+    public void setup() {
+        addState(new ISO8061State());
+    }
+}
diff --git a/TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/States/ServoTestState.java b/TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/States/ServoTestState.java
new file mode 100644
index 0000000..3df3a75
--- /dev/null
+++ b/TeamCode/src/main/java/org/timecrafters/FreightFrenzy/HardwareTesting/States/ServoTestState.java
@@ -0,0 +1,23 @@
+package org.timecrafters.FreightFrenzy.HardwareTesting.States;
+
+import org.cyberarm.engine.V2.CyberarmState;
+
+public class ServoTestState extends CyberarmState {
+
+    Servo transferServo;
+
+    public void init() {
+        transferServo = engine.hardwareMap.servo.get("Transfer_Servo");
+    }
+
+    @Override
+    public void exec() {
+        transferServo.setPosition(0.0);
+    }
+
+    @Override
+    public void telemetry() {
+        engine.telemetry.addLine("The ISO8061 Date Format is Best");
+        engine.telemetry.addLine("YYYY-MM-DD");
+    }
+}