From 729ba8a96953c44bd12694279fe6757f1513fc83 Mon Sep 17 00:00:00 2001
From: Nick Haemel <nhaemel@gmail.com>
Date: Tue, 22 Aug 2023 17:19:44 -0700
Subject: [PATCH] Add Motor Test Code

---
 .../ftc/teamcode/Motor_Test.java              | 49 +++++++++++++++++++
 1 file changed, 49 insertions(+)
 create mode 100644 TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Motor_Test.java

diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Motor_Test.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Motor_Test.java
new file mode 100644
index 0000000..470cbd9
--- /dev/null
+++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/Motor_Test.java
@@ -0,0 +1,49 @@
+package org.firstinspires.ftc.teamcode;
+
+import static org.firstinspires.ftc.robotcore.external.BlocksOpModeCompanion.hardwareMap;
+
+import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
+import com.qualcomm.robotcore.eventloop.opmode.OpMode;
+import com.qualcomm.robotcore.hardware.DcMotor;
+
+import java.util.concurrent.TimeUnit;
+
+@Autonomous(name="Motor_test")
+public class Motor_Test extends OpMode {
+    DcMotor hwMotorDriveFrontLeft;
+    DcMotor hwMotorDriveFrontRight;
+
+    DcMotor hwMotorDriveBackLeft;
+    DcMotor hwMotorDriveBackRight;
+
+    public void init() {
+        hwMotorDriveFrontLeft = hardwareMap.dcMotor.get("Drive front lt");
+        hwMotorDriveFrontRight = hardwareMap.dcMotor.get("Drive front rt");
+        hwMotorDriveBackLeft = hardwareMap.dcMotor.get("Drive back lt");
+        hwMotorDriveBackRight = hardwareMap.dcMotor.get("Drive back rt");
+    }
+
+    public void sleepSec(int iSecs){
+        try {
+            Thread.sleep(iSecs*1000);
+        } catch (InterruptedException e) {
+            Thread.currentThread().interrupt();
+        }
+    }
+    public void loop() {
+        hwMotorDriveFrontLeft.setPower(1);
+        sleepSec(1);
+        hwMotorDriveFrontRight.setPower(1);
+        sleepSec(1);
+        hwMotorDriveBackLeft.setPower(1);
+        sleepSec(1);
+        hwMotorDriveBackRight.setPower(1);
+        sleepSec(1);
+        hwMotorDriveFrontLeft.setPower(0);
+        hwMotorDriveFrontRight.setPower(0);
+        hwMotorDriveBackLeft.setPower(0);
+        hwMotorDriveBackRight.setPower(0);
+        sleepSec(10);
+    }
+
+}