Skip to content

Commit 617cc9a

Browse files
committed
Add vars for X & Y axis
1 parent d3e18d7 commit 617cc9a

File tree

1 file changed

+23
-7
lines changed

1 file changed

+23
-7
lines changed

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/FourMotorTest.java

Lines changed: 23 additions & 7 deletions
Original file line numberDiff line numberDiff line change
@@ -23,14 +23,30 @@ public void runOpMode() {
2323

2424
waitForStart();
2525

26-
double controllerPower = 0;
26+
double conPwrX = 0;
27+
double conPwrY = 0;
2728
while (opModeIsActive()) {
28-
controllerPower = -this.gamepad1.left_stick_y;
29-
Motor1.setPower(controllerPower);
30-
Motor2.setPower(controllerPower);
31-
Motor3.setPower(controllerPower);
32-
Motor4.setPower(controllerPower);
33-
telemetry.addData("Target Power", controllerPower);
29+
conPwrX = -this.gamepad1.left_stick_x;
30+
conPwrY = -this.gamepad1.left_stick_y;
31+
Motor1.setPower(-conPwrY);
32+
Motor2.setPower(conPwrY);
33+
Motor3.setPower(conPwrY);
34+
Motor4.setPower(-conPwrY);
35+
36+
/*
37+
Diagonal Strafe
38+
M1 = +
39+
M2 = +
40+
M3 = -
41+
M4 = -
42+
43+
Forward & Back
44+
M1 = -
45+
M2 = +
46+
M3 = +
47+
M4 = -
48+
*/
49+
telemetry.addData("Target Power", conPwrY);
3450
telemetry.addData("Motor1", Motor1.getPower());
3551
telemetry.addData("Motor2", Motor2.getPower());
3652
telemetry.addData("Motor3", Motor3.getPower());

0 commit comments

Comments
 (0)