|
12 | 12 | import org.firstinspires.ftc.teamcode.vision.TensorFlowDetection;
|
13 | 13 |
|
14 | 14 | 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)); |
16 | 16 | Vector2d BLUE_AUDIENCE_TAPE_MARKS = new Vector2d(-3 * 12, 2 * 12 + 12);
|
17 | 17 | Vector2d RED_BOARD_TAPE_MARKS = new Vector2d(fi(1,0), fi(-3,0));
|
18 | 18 | Vector2d BLUE_BOARD_TAPE_MARKS = new Vector2d(12, 2 * 12 + 12);
|
@@ -57,13 +57,17 @@ public void drive() {
|
57 | 57 | if (getRobot().getClass() == RoboticaBot.class && (getRobot().getDrive().currentQuadrant() == TrajectoryDrive.Quadrant.RED_BOARD || getRobot().getDrive().currentQuadrant() == TrajectoryDrive.Quadrant.BLUE_AUDIENCE)) {
|
58 | 58 | trajB.turn(Math.toRadians(45))
|
59 | 59 | .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); |
60 | 64 | } else {
|
61 | 65 | trajB.turn(Math.toRadians(90))
|
62 | 66 | .forward(8 * driveBackwards); // orig 13
|
63 | 67 | }
|
64 | 68 | } else if (propPosition == TensorFlowDetection.PropPosition.RIGHT) {
|
65 | 69 | trajB.turn(Math.toRadians(-90))
|
66 |
| - .forward(12 * driveBackwards); |
| 70 | + .forward(10 * driveBackwards); |
67 | 71 | } else {
|
68 | 72 | if (moveTowardsCenter) {
|
69 | 73 | trajB.turn(Math.toRadians(180))
|
|
0 commit comments