Skip to content

Commit 47000cc

Browse files
committed
added teleop
1 parent 5a92aed commit 47000cc

File tree

1 file changed

+40
-0
lines changed

1 file changed

+40
-0
lines changed
Lines changed: 40 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,40 @@
1+
package org.firstinspires.ftc.ptechnodactyl.opmodes.tele;
2+
3+
import com.acmerobotics.dashboard.FtcDashboard;
4+
import com.acmerobotics.dashboard.telemetry.MultipleTelemetry;
5+
import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
6+
import com.technototes.library.command.CommandScheduler;
7+
import com.technototes.library.structure.CommandOpMode;
8+
import com.technototes.library.util.Alliance;
9+
import org.firstinspires.ftc.ptechnodactyl.Hardware;
10+
import org.firstinspires.ftc.ptechnodactyl.Robot;
11+
import org.firstinspires.ftc.ptechnodactyl.Setup;
12+
import org.firstinspires.ftc.ptechnodactyl.commands.EZCmd;
13+
import org.firstinspires.ftc.ptechnodactyl.controllers.DriverController;
14+
import org.firstinspires.ftc.ptechnodactyl.controllers.OperatorController;
15+
import org.firstinspires.ftc.ptechnodactyl.helpers.StartingPosition;
16+
17+
@TeleOp(name = "Driving w/Turbo!")
18+
@SuppressWarnings("unused")
19+
public class JustDrivingTeleOp extends CommandOpMode {
20+
21+
public Robot robot;
22+
public DriverController controlsDriver;
23+
public OperatorController controlsOperator;
24+
public Hardware hardware;
25+
26+
@Override
27+
public void uponInit() {
28+
telemetry = new MultipleTelemetry(telemetry, FtcDashboard.getInstance().getTelemetry());
29+
hardware = new Hardware(hardwareMap);
30+
robot = new Robot(hardware);
31+
controlsOperator = new OperatorController(codriverGamepad, robot);
32+
if (Setup.Connected.DRIVEBASE) {
33+
controlsDriver = new DriverController(driverGamepad, robot);
34+
CommandScheduler.scheduleForState(
35+
EZCmd.Drive.ResetGyro(robot.drivebaseSubsystem),
36+
OpModeState.INIT
37+
);
38+
}
39+
}
40+
}

0 commit comments

Comments
 (0)