-
Notifications
You must be signed in to change notification settings - Fork 5
/
RepoBlueFarB.java
67 lines (64 loc) · 1.47 KB
/
RepoBlueFarB.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
package workspace;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
@Autonomous(name="Reposition, Blue, Far, B start" )
public class RepoBlueFarB 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
left(1);
forward(1.8);
right(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();
left(.3);
pause(1);
fingerUp();
strafeRight(1.45);
forward(2.1);
strafeLeft(1.5);
backward(2.1);
forward(.45);
right(1.2);
forward(2.3);
closeClaw();
/*fingerUp();
forward(0.76);
pause(0.5);
strafeLeft(2);
pause(0.5);
armUp();
pause(0.5);
forward(0.45);
pause(0.5);
fingerDown();
pause(2);
backward(2);
pause(2);
fingerUp();
pause(1);
armDown();
strafeRight(1.4);
forward(1.5);
right(1);
forward(1);*/
}
}