@@ -78,6 +78,19 @@ public class AutoConstants {
7878 public static ConfigurablePoseD SUBMARINE = new ConfigurablePoseD (-5 , 36 , (90 ));
7979 public static ConfigurablePoseD OBSERVATION_ZONE = new ConfigurablePoseD (-46 , 55 , (90 ));
8080
81+
82+ //stolen constants from 16750 heehee
83+ public static ConfigurablePoseD NETSCORING = new ConfigurablePoseD (55 , 57 , -135 );
84+ public static ConfigurablePoseD NET_START = new ConfigurablePoseD (35 , 63 , 180 );
85+ public static ConfigurablePoseD NET_AGAINST_THE_WALL = new ConfigurablePoseD (35 , 63 , -90 );
86+ public static ConfigurablePoseD NETCLEAR = new ConfigurablePoseD (52 , 52 , 45 );
87+ public static ConfigurablePoseD INTAKE1 = new ConfigurablePoseD (47 , 50 , -90 );
88+ public static ConfigurablePoseD INTAKE2 = new ConfigurablePoseD (57 , 50 , -90 );
89+ public static ConfigurablePoseD INTAKE3 = new ConfigurablePoseD (53 , 40 , -30 );
90+ public static ConfigurablePoseD ASCENT = new ConfigurablePoseD (23 , 12 , 0 );
91+ public static ConfigurablePoseD ASCENT_CLEAR = new ConfigurablePoseD (35 , 10 , 0 );
92+ //end of the crimes
93+
8194 public static final Function <Function <Pose2d , TrajectorySequenceBuilder >, TrajectorySequence >
8295 OBS_START_TO_OBS_PARK = b ->
8396 b .apply (OBS_START .toPose ()).lineToLinearHeading (OBS_PARK .toPose ()).build ();
@@ -291,17 +304,27 @@ public class AutoConstants {
291304 .lineToLinearHeading (REST .toPose ())
292305 .build ();
293306
307+ // "borrowed" from 16750 sample side auto
308+ public static final Function <Function <Pose2d , TrajectorySequenceBuilder >, TrajectorySequence >
309+ START_TO_NETSCORING = b ->
310+ b .apply (NET_START .toPose ()).lineToLinearHeading (NETSCORING .toPose ()).build ();
311+ public static final Function <Function <Pose2d , TrajectorySequenceBuilder >, TrajectorySequence >
312+ NETSCORING_TO_INTAKE1 = b ->
313+ b .apply (NETSCORING .toPose ()).lineToLinearHeading (INTAKE1 .toPose ()).build ();
314+ public static final Function <Function <Pose2d , TrajectorySequenceBuilder >, TrajectorySequence >
315+ INTAKE1_TO_NETSCORING = b ->
316+ b .apply (INTAKE1 .toPose ()).lineToLinearHeading (NETSCORING .toPose ()).build ();
294317
295-
318+ //end of borrowing
296319
297320 //New testing constants for this year's game
298- // public static ConfigurablePoseD START = new ConfigurablePoseD(35, 63, 0);
299- // public static ConfigurablePoseD OBS_START = new ConfigurablePoseD(22, -65, 90);
300- // public static ConfigurablePoseD NETSCORING_TEST = new ConfigurablePoseD(55, 55, 45);
301- // public static ConfigurablePoseD NETSCORING_CLEAR = new ConfigurablePoseD(45, 35, -45);
302- // public static ConfigurablePoseD SPLINETEST1 = new ConfigurablePoseD(0, -55, 0);
303- // public static ConfigurablePoseD SPLINETEST2 = new ConfigurablePoseD(55, 0, 0);
304- // public static ConfigurablePoseD OBS_PARK = new ConfigurablePoseD(62, -6, 90);
321+ public static ConfigurablePoseD START = new ConfigurablePoseD (35 , 63 , 0 );
322+ // public static ConfigurablePoseD OBS_START = new ConfigurablePoseD(22, -65, 90);
323+ public static ConfigurablePoseD NETSCORING_TEST = new ConfigurablePoseD (55 , 55 , 45 );
324+ public static ConfigurablePoseD NETSCORING_CLEAR = new ConfigurablePoseD (45 , 35 , -45 );
325+ public static ConfigurablePoseD SPLINETEST1 = new ConfigurablePoseD (0 , -55 , 0 );
326+ public static ConfigurablePoseD SPLINETEST2 = new ConfigurablePoseD (55 , 0 , 0 );
327+ // public static ConfigurablePoseD OBS_PARK = new ConfigurablePoseD(62, -6, 90);
305328
306329 public static ConfigurablePoseD NETSCORING = new ConfigurablePoseD (55 , 55 , 45 );
307330 public static ConfigurablePoseD NET_START = new ConfigurablePoseD (35 , 63 , 0 );
0 commit comments