SCDS/FtcRobotController
7
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

red side perfect (atleast I think)

Browse Source
This commit is contained in:
robotics2
2024-01-09 17:08:54 -08:00
parent 84aba36915
commit 8108e5c42f
1 changed files with 5 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

11
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/RedBackStage.java
View File

@ -180,8 +180,6 @@ public class RedBackStage extends LinearOpMode {
double turning_distance = degrees * DEGREE_TOO_DISTANCE; double turning_distance = degrees * DEGREE_TOO_DISTANCE;
encoderDrive(DRIVE_SPEED, turning_distance, turning_distance, LONG_TIMEOUT); encoderDrive(DRIVE_SPEED, turning_distance, turning_distance, LONG_TIMEOUT);
} }
public void raisearm(int degrees) { public void raisearm(int degrees) {
armEncoder(ARM_SPEED, degrees*TICKS_TO_DEGREES, LONG_TIMEOUT); armEncoder(ARM_SPEED, degrees*TICKS_TO_DEGREES, LONG_TIMEOUT);
@ -253,14 +251,14 @@ public class RedBackStage extends LinearOpMode {
telemetry.update(); telemetry.update();
turnLeft(90); turnLeft(90);
straightLeft(2); straightLeft(2);
driveForward(6); driveForward(5.5);
raisearm(80); raisearm(80);
arm.setPower(0); arm.setPower(0);
driveForward(-21); driveForward(-21);
straightLeft(32); straightLeft(34);
driveForward(-10); driveForward(-10);
straightRight(33); straightRight(35);
driveForward(-7.5); driveForward(-5);
raisearm(80); raisearm(80);
wrist.setPosition(0); wrist.setPosition(0);
raisearm(100); raisearm(100);
@ -310,6 +308,7 @@ else
straightLeft(15); straightLeft(15);
driveForward(-18); driveForward(-18);
straightRight(29); straightRight(29);
turnRight(10);
raisearm(80); raisearm(80);
wrist.setPosition(0); wrist.setPosition(0);
raisearm(100); raisearm(100);