Tank drive w/ bumper strafe yay

This commit is contained in:
Sodi
2022-08-25 19:29:09 -05:00
parent ff864b2668
commit 98ade45485
2 changed files with 59 additions and 0 deletions

View File

@@ -0,0 +1,24 @@
package org.timecrafters.minibots.cyberarm.engines;
import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
import org.cyberarm.engine.V2.CyberarmEngine;
import org.timecrafters.minibots.cyberarm.states.MecanumRobot;
import org.timecrafters.minibots.cyberarm.states.PingPongState;
@TeleOp (name = "Sodi PingPong")
public class PingPongEngine extends CyberarmEngine {
MecanumRobot robot;
@Override
public void setup() {
robot = new MecanumRobot(this);
addState(new PingPongState(robot));
}
}

View File

@@ -0,0 +1,35 @@
package org.timecrafters.minibots.cyberarm.states;
import org.cyberarm.engine.V2.CyberarmState;
public class PingPongState extends CyberarmState {
private final MecanumRobot robot;
public PingPongState(MecanumRobot robot) {
this.robot = robot;
}
@Override
public void exec() {
if (engine.gamepad1.left_bumper) {
robot.frontLeftDrive.setPower(1);
robot.backLeftDrive.setPower(-1);
robot.backRightDrive.setPower(1);
robot.frontRightDrive.setPower(-1);
}
else if (engine.gamepad1.right_bumper) {
robot.frontLeftDrive.setPower(-1);
robot.backLeftDrive.setPower(1);
robot.frontRightDrive.setPower(1);
robot.backRightDrive.setPower(-1);
}
else {
robot.backLeftDrive.setPower(engine.gamepad1.left_stick_y);
robot.frontLeftDrive.setPower(engine.gamepad1.left_stick_y);
robot.backRightDrive.setPower(engine.gamepad1.right_stick_y);
robot.frontRightDrive.setPower(engine.gamepad1.right_stick_y);
}
}
}