屎1.1

src/main/java/frc/robot/Robot.java

@@ -3,6 +3,8 @@
 // the WPILib BSD license file in the root directory of this project.
 
 package frc.robot;
+import edu.wpi.first.math.geometry.Pose2d;
+import edu.wpi.first.math.geometry.Rotation2d;
 import edu.wpi.first.wpilibj.TimedRobot;
 import edu.wpi.first.wpilibj2.command.Command;
 import edu.wpi.first.wpilibj2.command.CommandScheduler;

src/main/java/frc/robot/RobotContainer.java

@@ -74,6 +74,15 @@ public class RobotContainer {
 
   
   public RobotContainer() {
+
+    Pose2d startingPose = Constants.StartingPoints.Red.Point2;
+    drivetrain.resetPose(startingPose);
+    configueSwerve();
+    configueShooter();
+    configueClimber();
+    bingdingLED();
+    configueIntaker();
+    //configureBindings();
     Autocommand.preNameCommands(
         climberSubsystem,
         IntakerSubsystem,
@@ -82,16 +91,9 @@ public class RobotContainer {
         driveControls,
         shooterControls
     );
-
     SignalLogger.enableAutoLogging(false);
     autoChooser = AutoBuilder.buildAutoChooser();
     SmartDashboard.putData("Auto Chooser", autoChooser);
-    configueSwerve();
-    configueShooter();
-    configueClimber();
-    bingdingLED();
-    configueIntaker();
-    //configureBindings();
   }
 
   /* ====================== */