@@ -27,28 +27,29 @@ protected Command getRedAutoCommand() {
27
27
Commands .runOnce (
28
28
() ->
29
29
robotManager .localization .resetPose (
30
- new Pose2d (15.811 , 6.713 , new Rotation2d (-170.80 )))),
30
+ new Pose2d (15.78 , 6.67 , new Rotation2d (-58.39 )))),
31
31
trailblazer .followSegment (
32
32
new AutoSegment (
33
- new AutoPoint (new Pose2d (15.811 , 6.713 , new Rotation2d (-170.80 ))),
33
+ new AutoPoint (new Pose2d (15.78 , 6.67 , new Rotation2d (-58.39 ))),
34
34
new AutoPoint (
35
35
new Pose2d (14.676 , 6.767 , new Rotation2d (-26.85 )),
36
36
Commands .sequence (
37
37
autoCommands .speakerShotWithTimeout (), actions .intakeAssistCommand ())),
38
- new AutoPoint (new Pose2d (13.959 , 6.872 , new Rotation2d ())),
38
+ new AutoPoint (new Pose2d (13.68 , 6.99 , new Rotation2d (0.0 ))),
39
39
new AutoPoint (
40
- new Pose2d (12.64 , 7.063 , new Rotation2d ()),
40
+ new Pose2d (12.64 , 7.06 , new Rotation2d (- 21.67 )),
41
41
Commands .sequence (
42
42
autoCommands .speakerShotWithTimeout (), actions .intakeAssistCommand ())),
43
- new AutoPoint (new Pose2d (8.605 , 7.449 , new Rotation2d (0.0 ))),
43
+ new AutoPoint (new Pose2d (8.52 , 7.46 , new Rotation2d (0.0 ))),
44
44
new AutoPoint (
45
- new Pose2d (12.64 , 7.063 , new Rotation2d (-8.0 )),
45
+ new Pose2d (12.64 , 7.06 , new Rotation2d (-21.67 )),
46
46
autoCommands .speakerShotWithTimeout ()),
47
47
new AutoPoint (
48
- new Pose2d (11.033 , 6.879 , new Rotation2d ()), actions .intakeAssistCommand ()),
49
- new AutoPoint (new Pose2d (10.827 , 6.42 , new Rotation2d ())),
48
+ new Pose2d (11.03 , 6.88 , new Rotation2d (30.17 )), actions .intakeAssistCommand ()),
49
+ new AutoPoint (new Pose2d (10.14 , 6.41 , new Rotation2d (25.43 )), actions .intakeAssistCommand ()),
50
+ new AutoPoint (new Pose2d (8.32 , 8.32 , new Rotation2d (24.67 )), actions .intakeAssistCommand ()),
50
51
new AutoPoint (
51
- new Pose2d (12.553 , 6.036 , new Rotation2d (-8.0 )),
52
+ new Pose2d (12.64 , 7.06 , new Rotation2d (-21.67 )),
52
53
autoCommands .speakerShotWithTimeout ()))));
53
54
}
54
55
}
0 commit comments