-
Notifications
You must be signed in to change notification settings - Fork 0
/
BlueParallel.java
51 lines (39 loc) · 1.16 KB
/
BlueParallel.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
package org.firstinspires.ftc.teamcode.Stuff_From_Loveland;
import com.qualcomm.robotcore.eventloop.opmode.Autonomous;
import com.qualcomm.robotcore.util.ElapsedTime;
/**
* Created by Sushr on 12/15/2017.
*/
@Autonomous(name = "BlueParallel", group = "fjfrjkdk")
public class BlueParallel extends Processor{
int count = 0;
boolean touch = false;
ElapsedTime time = new ElapsedTime();
@Override
public void runOpMode() throws InterruptedException {
bot.init(hardwareMap);
waitForStart();
checkVu();
checkCol();
grabGlyph();
//knocks the correct jewel off according to our alliance colo
//knocks the correct jewel off according to our alliance color
knockJewel(false);
goAngle(18,180);
sleep(500);
align(0);
turn(-180);
align(180);
sleep(750);
raiseColorServo();
drivingRangeForwardBlue();
drivingRangeBackBlue();
gotoColumnRight();
stopBotMotors();
bot.colorServo.setPosition(0);
sleep(500);
align(180);
//driveToDistance();
score();
stopBotMotors(); }
}