This repository was archived by the owner on Sep 6, 2021. It is now read-only.
Repository navigation
Expand file tree
/
Copy pathteleopTemplate.java
More file actions
72 lines (62 loc) · 2.15 KB
/
Copy pathteleopTemplate.java
File metadata and controls
72 lines (62 loc) · 2.15 KB
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
package org.firstinspires.ftc.teamcode;
import com.qualcomm.robotcore.eventloop.opmode.LinearOpMode;
import com.qualcomm.robotcore.eventloop.opmode.TeleOp;
import com.qualcomm.robotcore.util.ElapsedTime;
@TeleOp(name="template", group="Pushboat")
public class template extends LinearOpMode {
shellFish shell = new shellFish();
toggleMap toggleMap1 = new toggleMap();
useMap useMap1 = new useMap();
toggleMap toggleMap2 = new toggleMap();
useMap useMap2 = new useMap();
private ElapsedTime runtime = new ElapsedTime();
@Override
public void runOpMode() {
shell.init(hardwareMap);
shell.imu();
while(!opModeIsActive()){
}
while(opModeIsActive()){
updateKeys();
telemetry.update();//THIS GOES AT THE END
}
}
////////////////////////////////
// TOGGLES ////////// USE MAP //
////////////////////////////////
public void updateKeys(){
if(gamepad1.a && cdCheck(useMap1.a, 1000)){
toggleMap1.a = toggle(toggleMap1.a);
useMap1.a = runtime.milliseconds();
}
if(gamepad1.b && cdCheck(useMap1.b, 500)){
toggleMap1.b = toggle(toggleMap1.b);
useMap1.b = runtime.milliseconds();
}
if(gamepad2.b && cdCheck(useMap2.b, 500)){
toggleMap2.b = toggle(toggleMap2.b);
useMap2.b = runtime.milliseconds();
}
if(gamepad1.right_stick_x > 0 && cdCheck(useMap1.right_stick_x_pos, 700)){
toggleMap1.right_stick_x_pos = toggle(toggleMap1.right_stick_x_pos);
useMap1.right_stick_x_pos = runtime.milliseconds();
}
}
public boolean cdCheck(double key, int cdTime){
return runtime.milliseconds() - key > cdTime;
}
public boolean toggle(boolean variable){
if(variable == true){
variable = false;
}
else if(variable == false){
variable = true;
}
return variable;
}
public void customTelemetry(string 1, string 2){
if(cdCheck(useMap1.left_stick_button, 500)){
telemetry.addData(1, 2);
}
}
}