Fix blue side initial heading
This commit is contained in:
parent
2dcd1aa28e
commit
a67205657b
|
@ -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}
|
||||
);
|
||||
|
|
|
@ -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}
|
||||
);
|
||||
|
|
|
@ -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}
|
||||
);
|
||||
|
|
Loading…
Reference in a new issue