Fix blue side initial heading

This commit is contained in:
Yash Karandikar 2022-11-05 19:24:04 -05:00
parent 2dcd1aa28e
commit a67205657b
3 changed files with 3 additions and 3 deletions

View file

@ -24,7 +24,7 @@ public class AutoBlueColorSensor extends LinearOpMode {
Trajectory firstMove = api.makeTrajectories(
mecanumDrive,
new Pose2d(new Vector2d(-34, 60), 0),
new Pose2d(new Vector2d(-34, 60), 270),
new int[]{-34},
new int[]{40}
);

View file

@ -24,7 +24,7 @@ public class AutoBlueSubstationParkingBehavior extends LinearOpMode {
// init move to default terminal
Trajectory endpos = api.makeTrajectories(
mecanumDrive,
new Pose2d(new Vector2d(-34, 60), 0),
new Pose2d(new Vector2d(-34, 60), 270),
new int[]{-34, 1},
new int[]{60, 60}
);

View file

@ -24,7 +24,7 @@ public class AutoBlueTerminalParkingBehavior extends LinearOpMode {
// init move to default terminal
Trajectory endpos = api.makeTrajectories(
mecanumDrive,
new Pose2d(new Vector2d(-34, 60), 0),
new Pose2d(new Vector2d(-34, 60), 270),
new int[]{-34, -70},
new int[]{60, 60}
);