-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathTeleOp.java
62 lines (43 loc) · 1.11 KB
/
TeleOp.java
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
package org.firstinspires.ftc.teamcode;
import com.qualcomm.robotcore.eventloop.opmode.linearOpmode;
import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
@TeleOp (name = "TeleOp10620", group = "PioneerMiddleSchool")
public class TeleOp10620 extends LinearOpMode
{
private DcMotor motorLeft;
private DcMotor motorRight;
private DcMotor hexMotor;
@override
public void runOpMode() throws InterruptedException
{
motorLeft = hardwaremap.dcmotor.get("motorLeft");
motorRight = hardwaremap.dcmotor.get("motorRight");
hexMotor = hardwaremap.dcmotor.get("hexMotor")
motorLeft.setDirection(DcMotor.Direction.REVERSE);
waitforstart();
while(OpModeisActive())
{
motorLeft.setPower(-gamepad1.left_stick_y);
motorRight.setPower(-gamepad1.left_stick_y);
if(gamepad1.a)
{
motorLeft.setPower(0);
motorRight.setPower(0);
}
if(gamepad1.y)
{
motorLeft.setPower(0.9);
motorRight.setPower(0.9);
}
if(gamepad2.right_bumper)
{
hexMotor.setPower(0.8)
}
if(gamepad2.left_bumper)
{
hexMototr.setPower(-0.8);
}
idle();
}
}
}