-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathauton.java
119 lines (91 loc) · 2.39 KB
/
auton.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
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
package org.firstinspires.ftc.teamcode;
import com.qualcomm.robotcore.eventloop.opmode.linearOpmode;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
@Autonomous (name = "Auton10620")
public class Auton10620 extends LinearOpMode
{
private DcMotor motorLeft;
private DcMotor motorRight;
@override public void runOpMode() throws InteruptedException
{
motorLeft = hardware.dcmotor.get("motorLeft");
motorRight = hardware.dcmotor.get("motorRight");
motorLeft.setChannleMode(DcMotorController.RunMode.RUN_WITHOUT_ENCODER);
motorRight.setChannleMode(DcMotorController.RunMode.RUN_WITHOUT_ENCODER);
motorLeft.setDirection(DcMotor.Direction.REVERSE);
waitforstart();
DriveForwardTime(DRIVE_POWER, 4000);
TurnLeftTime(DRIVE_POWER, 500);
DriveForwardTime(DRIVE_POWER, 4000);
TurnRightTime(DRIVE_POWER, 500);
DriveForwardTime(DRIVE_POWER, 4000);
stopDriving();
double DRIVE_POWER(1.0);
public void DriveForward(double power);
{
motorLeft.setPower(power);
motorRight.setPower(power);
}
public void DriveForwardTime(double power, long time) throws InterruptedException
{
DriveForward(power);
Thread.sleep(time);
}
public void StopDriving()
{
DriveForward(0.0);
}
public void TurnLeft(double power);
{
motorLeft.setPower(-power);
motorRight.setPower(power);
}
public void TurnLeftTime(double power, long time) throws InterruptedException
{
TurnLeft(power);
Thread.sleep(time);
}
public void DriveForward(double power);
{
motorLeft.setPower(power);
motorRight.setPower(power);
}
public void DriveForwardTime(double power, long time) throws InterruptedException
{
DriveForward(power);
Thread.sleep(time);
}
public void StopDriving()
{
DriveForward(0.0);
}
public void TurnRight(double power);
{
motorLeft.setPower(power);
motorRight.setPower(-power);
}
public void TurnRightTime(double power, long time) throws InterruptedException
{
TurnRight(power);
Thread.sleep(time);
}
public void DriveForward(double power);
{
motorLeft.setPower(power);
motorRight.setPower(power);
}
public void DriveForwardTime(double power, long time) throws InterruptedException
{
DriveForward(power);
Thread.sleep(time);
}
public void StopDriving()
{
DriveForward(0.0);
}
while(OpModeisActive());
{
idle();
}
}
}