karx/FreeOfCharge2022-23
1
1
Fork 0
Code Issues Pull requests Packages Projects Releases Wiki Activity

Auto stuff

Browse source
This commit is contained in:
Yash Karandikar 2022-11-09 18:17:18 -06:00
parent 6949c666b8
commit 558be5987b
2 changed files with 37 additions and 11 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

16
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/createdcode/enhancedautos/AutoBlueColorSensor.java
View file

@ -15,7 +15,9 @@ public class AutoBlueColorSensor extends LinearOpMode {
waitForStart();
movementAPI.move(0, 0.7);
api.pause(0.25);
api.pause(0.4);
movementAPI.move(-90, 0.7);
api.pause(0.15);
movementAPI.stop();
api.pause(5);
@ -25,9 +27,7 @@ public class AutoBlueColorSensor extends LinearOpMode {
if (r < 100 && g < 100 && b < 100) {
movementAPI.move(-180, 0.7);
api.pause(0.25);
movementAPI.move(-180, 0.7);
api.pause(0.5);
api.pause(0.75);
movementAPI.move(90, 0.7);
api.pause(0.7);
movementAPI.stop();
@ -43,16 +43,24 @@ public class AutoBlueColorSensor extends LinearOpMode {
if (largest == g) {
// move to position 1
movementAPI.move(-180, 0.7);
api.pause(0.75);
movementAPI.move(90, 0.7);
api.pause(0.25);
movementAPI.move(180, 0.7);
api.pause(0.75);
} else if (largest == r) {
// move to position 2
movementAPI.move(0, 0.7);
api.pause(0.25);
} else if (largest == b) {
// move to position 3
movementAPI.move(-180, 0.7);
api.pause(0.75);
movementAPI.move(-90, 0.7);
api.pause(0.25);
movementAPI.move(180, 0.7);
api.pause(0.75);
}
movementAPI.stop();

32
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/createdcode/enhancedautos/AutoRedColorSensor.java
View file

@ -15,7 +15,9 @@ public class AutoRedColorSensor extends LinearOpMode {
waitForStart();
movementAPI.move(0, 0.7);
api.pause(0.5);
api.pause(0.4);
movementAPI.move(90, 0.7);
api.pause(0.15);
movementAPI.stop();
api.pause(5);
@ -23,26 +25,42 @@ public class AutoRedColorSensor extends LinearOpMode {
int g = sensor.green();
int b = sensor.blue();
if (r < 100 && g < 100 && b < 100) {
movementAPI.move(-180, 0.7);
api.pause(0.75);
movementAPI.move(-90, 0.7);
api.pause(0.7);
movementAPI.stop();
terminateOpModeNow();
}
int largest = api.getLargest(r, g, b);
api.print("r", String.valueOf(r));
api.print("g", String.valueOf(g));
api.print("b", String.valueOf(b));
if (largest == g) {
// move to position 1
movementAPI.move(-180, 0.7);
api.pause(0.75);
movementAPI.move(-90, 0.7);
api.pause(0.25);
movementAPI.move(180, 0.7);
api.pause(0.75);
} else if (largest == r) {
// move to position 2
movementAPI.move(0, 0.7);
api.pause(0.25);
} else if (largest == b) {
// move to position 3
movementAPI.move(-180, 0.7);
api.pause(0.75);
movementAPI.move(90, 0.7);
api.pause(0.25);
} else {
// Color sensor broke, move to backup position
movementAPI.move(-180, 0.7);
api.pause(0.5);
movementAPI.move(-90, 0.7);
api.pause(0.7);
movementAPI.move(180, 0.7);
api.pause(0.75);
}
movementAPI.stop();