Skip to content

Commit 5aa04a4

Browse files
committed
purple pixel fix a bit
1 parent 2235cd8 commit 5aa04a4

File tree

1 file changed

+6
-2
lines changed

1 file changed

+6
-2
lines changed

TeamCode/src/main/java/org/firstinspires/ftc/teamcode/opmode/components/PurplePixelComponent.java

Lines changed: 6 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -12,7 +12,7 @@
1212
import org.firstinspires.ftc.teamcode.vision.TensorFlowDetection;
1313

1414
public class PurplePixelComponent extends Component {
15-
Vector2d RED_AUDIENCE_TAPE_MARKS = new Vector2d(fi(-3,0), fi(-3,0));
15+
Vector2d RED_AUDIENCE_TAPE_MARKS = new Vector2d(fi(-3,2), fi(-3,0));
1616
Vector2d BLUE_AUDIENCE_TAPE_MARKS = new Vector2d(-3 * 12, 2 * 12 + 12);
1717
Vector2d RED_BOARD_TAPE_MARKS = new Vector2d(fi(1,0), fi(-3,0));
1818
Vector2d BLUE_BOARD_TAPE_MARKS = new Vector2d(12, 2 * 12 + 12);
@@ -57,13 +57,17 @@ public void drive() {
5757
if (getRobot().getClass() == RoboticaBot.class && (getRobot().getDrive().currentQuadrant() == TrajectoryDrive.Quadrant.RED_BOARD || getRobot().getDrive().currentQuadrant() == TrajectoryDrive.Quadrant.BLUE_AUDIENCE)) {
5858
trajB.turn(Math.toRadians(45))
5959
.forward(12 * driveBackwards);
60+
} if (getRobot().getDrive().currentQuadrant() == TrajectoryDrive.Quadrant.RED_AUDIENCE) {
61+
trajB.forward(9 * driveBackwards)
62+
.turn(Math.toRadians(90))
63+
.forward(8 * driveBackwards);
6064
} else {
6165
trajB.turn(Math.toRadians(90))
6266
.forward(8 * driveBackwards); // orig 13
6367
}
6468
} else if (propPosition == TensorFlowDetection.PropPosition.RIGHT) {
6569
trajB.turn(Math.toRadians(-90))
66-
.forward(12 * driveBackwards);
70+
.forward(10 * driveBackwards);
6771
} else {
6872
if (moveTowardsCenter) {
6973
trajB.turn(Math.toRadians(180))

0 commit comments

Comments
 (0)