Add Motor Test Code

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);
+    }
+
+}