forked from IsaacRatliff/FTC-Code
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathRepoRedFarB.java
68 lines (65 loc) · 1.51 KB
/
RepoRedFarB.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
package workspace;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
@Autonomous(name="Reposition, Red, Far, B start" )
public class RepoRedFarB extends AutoOp {
// Start all the way toward the build side on the second tile from
// the middle on the stone side.
@Override
public void runOpMode() {
initialize(hardwareMap, telemetry);
waitForStart();
fingerUp();
openClaw();
forward(0.7); //0.45
pause(0.5);
//strafeRight(3.8); //3.75
right(1);
forward(1.8);
left(1);
pause(0.5);
//armUp();
// pause(0.5);
forward(0.475);
pause(0.5);
fingerDown();
pause(2);
backward(2.25); //2
//left(2);
pause(2);
// left(1);
// pause(1);
// armDown();
right(.3);
pause(1);
fingerUp();
strafeLeft(1.35);
forward(2);
strafeRight(1);
backward(2);
forward(.45);
left(1.2);
forward(1.7);
/*initialize(hardwareMap, telemetry);
waitForStart();
fingerUp();
forward(0.5);
pause(0.5);
strafeRight(2);
pause(0.5);
armUp();
pause(0.5);
forward(0.45);
pause(0.5);
fingerDown();
pause(2);
backward(2.25);
pause(2);
fingerUp();
pause(1);
armDown();
strafeLeft(1.6);
forward(1.5);
left(1);
forward(0.8);*/
}
}